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I-    INTRODBCTION 

In  pursuit  of  an  interest  in  the  problems  and  potential 
of  satellite  tracking  of  earth's  surface  or  low  altitude 
targets,  the  interested  student  quickly  discovers  a  plethora 
of  information  available  on  the  subject,  but  little  in  the 
way  of  analysis  of  the  entire  problem,  start-to-finish.  The 
purpose  of  this  report  then  is  to  provide  that  analysis, 
beginning  with  the  mechanics  of  the  orbiting  satellite;  next 
developing  a  model  to  represent  the  target  motion;  and 
continuing  through  an  observability  analysis  of  the  problem. 
Finally,  a  first-cut  attempt  is  made,  based  on  the  observ- 
ability study,  to  design  a  deterministic  nonlinear  observer 
and  an  Extended  Kalman  Filter  (hereafter  referred  to  as  an 
EKF)    to    observe   and    track    the    target. 

Chapter  II  of  this  report  examines  in  depth  the  physical 
dynamics  of  a  satellite  orbiting  the  Earth,  and  then  the 
target  moving  on  or  just  above  its  surface.  A  working  model 
is  developed  for  the  satellite,  including  a  look  at  its 
ground  track;  its  rotation  about  its  own  axes  as  it  iroves 
through  space;  and  the  translation  of  its  raw  observed  data 
into  earth's  surface  coordinates.  Both  position  and  rate 
data  are  considered,  and  specific  formulae  are  developed 
alone  the  lines  of  a  computer  algorithm  for  coordinate 
transformation. 

Chapter  III  deals  more  specifically  with  the  model  for 
the  target  itself.  Actually,  two  models  are  considered: 
first,  a  realistic  model,  necessarily  nonlinear,  due  tc  the 
non-synchronous  moticn  of  the  target  and  satellite  on 
concentric  spheres;  and  then  secondly  a  slightly  nonreal- 
istic  linearized  version.  Both  surface  and  air  targets  are 
considered,  but  for  brevity's  sake,  only  the  surface  target 
is   discussed   fully    in   the    various   examples. 
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Chapter  IV  finally  tackles  the  problem  of  state  observ- 
ability. Observability,  as  defined  here  and  in  [Eef.  1],  is 
the  capability,  given  the  observations  and  knowledge  of  the 
control  input  to  the  system  over  time,  to  reconstruct  the 
entire  system  state  tack  to  the  initial  condition.  Testing 
for  this  condition  on  a  linear  system  is  perfectly  straight- 
forward; the  method  is  fully  developed  in  [Ref.  2]  and  else- 
where. The  observability  of  the  nonlinear  system  is  by  far 
the  mere  interesting  problem,  as  the  problem  is  more  real- 
istic, and  the  methodology  for  testing  of  nonlinear  observ- 
ability is  far  less  well  developed  and/or  documented.  To 
that  end,  the  method  which  is  newly  developed  in  [Ref.  1]  is 
herein  employed,  and  the  analysis  ultimately  becomes  as  much 
of  a  test  of  the  methed  as  the  observability  of  the  system. 

Eased  on  the  results  of  the  analysis  in  Chapter  IV, 
Chapter  V  is  then  an  admittedly  imperfect,  first-cut  attempt 
at  designing  a  deterministic  ncnlinear  observer,  and  then 
tracking  the  target  with  an  EKP.  The  comments  in  [Ref.  3] 
concerning  filter  initialization  and  measurement  covariance 
estimation  become  pertinent. 

Finally,  Chapter  VI  summarizes  the  thesis'  results,  and 
makes  some  suggestions  for  farther  analysis,  specifically  in 
the  area  of  multiple  targets  and  observers.  Tie  real- world 
significance  of  the  report  is  also  discussed. 
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II.    SATELLITE    DYNAMICS    AND    OBSERVATION    OF    TARGETS 

In  considering  the  tracking  of  a  surface  or  air  target 
by  a  satellite  hurtling  through  space  at  speeds  approaching 
15000  knots,  it  is  obviously  imperative  to  understand  the 
dynamics  of  the  motion  of  the  satellite.  Only  then  can  a 
relative  coordinate  system  be  established,  with  the  ultimate 
goal  of  describing  the  target's  motion  over  the  Earth's 
surface;  first,  however  ,  the  satellite's  own  motion  must  be 
similarly   described. 

In  the  following  derivations,  the  Earth  will  be  approxi- 
mated by  a  uniformly-dense,  perfect  sphere.  This  approxima- 
tion has  often  been  characterized  c;uaiitatively  as  being 
twice  as  good  as  that  of  a  "spherical''  basketball;  its  quan- 
titative implications  will  be  discussed  in  Sections  B  and  C 
below . 

A.        SATELLITE    REFERENCE    ORBIT 

Lagrangian  Mechanics,  as  developed  in  [Ref.  4]  offers 
the  easiest  method  for  analyzing  the  satellite's  moticn. 
The  Earth  and  the  satellite  can  each  be  represented  by  point 
masses;  in  the  absence  of  external  disturbances,  it  can  be 
shown  that  the  satellite's  orbit  will  remain  planar.  The 
gravitational  potential  of  the  satellite  is  inversely 
proportional  to  its  distance  from  the  Earth;  using  circular 
polar  coordinates  as  shown  in  Figure  2.1,  this  potential 
energy  "V"    is   then    described    by 


v  -  ULVU   / 


r 


where   G    is    Newton's   constant    of    universal    gravitation,      M    is 
the    mass   of    the    Earth,      and    m       is    the    mass    of    the    satellite. 
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Figure  2. 1    Satellite  Orbit  in  its  Plane 


The   circular  orbit   is  the   sinplest  case,    such  that   the 
velocity  is  purely  tangential  and  can  be  characterized  as 


The  kinetic  energy  1  is  then 


T 


T 


1  m'Mc-  \i 

z. 


s  "-    ^™^<b 


and   in   the   absence  of   any   external   disturbances, 
lagrangian  function  is  written  as  follows: 

GNV 


of 


T-AJ  •-  i^H 


v\\ 


/ 


T 


Ey  the  rules  of  Lagrangian  mechanics, 


^v- 


the 


or 


O    -    rrvr 


4 


GOA 


\TV\ 


7_ 


(2.1) 
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dt  ^  £*$>  J  "      cxip 


or 


5tC^r^J    =  O  •  (2.2) 

Equation  2.2  indicates  that  angular  momentum  is 
conserved  (i.e.  its  derivative  is  zero),  and  that  ($>  will  be 
constant      for    a      given   orbital      radius.  Further,      if      the 

angular   momentum    vector   is    interpreted  as 


J)    -    *Y\  (  c  x.\l)  ~   w\srz§  c 


then  the  fact  of  its  conservation  indicates  that  the  or hit 
will  remain  stable  in  its  original  plane.  The  introduction 
of  a  third  coordinate,  which  ultimately  becomes  the  angle  of 
inclination  i,  and  which  remains  arbitrary  throughout  the 
Lagrangian    derivation,    proves    this   conclusively. 

Solving      equation   2. 1      for      the      the    physical      constants 
reveals    that 

Considering   that  <±>  -  f  j 

where   T   is    the    satellite's   period,    then 

r1  QH 


T2-  4-T\ 


2- 


for    a    satellite    in    an   earth      ortit;       this    is   Kepler's   Second 
law    of    Orbital    Motion. 

The  radius  in  this  equation  is  the  distance  of  the 
satellite  from  the  Earth's  center;  for  altitude  ahove  the 
Earth,    the    Earth's    radius,    here    represented    as 

r      =    3438nm   =   6366km 
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must  be  subtracted,  i.e. 

h  =  r  -  r 
o 

Of  special  interest  is  the  satellite  at  zero  altitude, 
also  known  as  a  Herget  satellite,  with  a  period  of  84.5 
minutes.  As  [fief-  5]  indicates,  this  gives  a  value  for  the 
lower  bound  of  a  satellite's  period.  Some  other  periods  and 
altitudes  of  interest  are  summarized  in  Table  I  : 


TABLE  I 
Typical  Periods,  Altitudes,  and  Orbital  Velocities 


Period  T 

90  min 

3  hr 

6  hr 

12  hr 

23  hr  56  min 


Altitude  h 

150  nn 

2250  nn 

5600  nm 

10900  nn 

19322  nm 


Orbital  Velocity 

15030  knots 

11930  knots 

9470  knots 

7510  knots 

5^70  knots 


This  last  orbit,  with  a  period  of  one  solar  day,  is  the 
geosynchronous  orbit  freguently  adopted  in  satellite  commu- 
nications applications;  for  tracking  of  surface-bound 
targets,  however,  low-altitude  orbits  kill  be  of  much 
greater  interest.  Typical  altitudes  will  generally  be  less 
than  1000  nautical  miles,  depending  on  the  sensitivity  and 
accuracy  of  the  tracking  sensor:  this  corresponds  to 
periods  of  two  hours  or  less. 

Finally,  it  can  be  shown  by  the  method  of  the  potential 
energy  well  [fief.  6],  and  alsc  by  the  application  of  the 
theory  of  perturbations  [Ref.  4 j,  that  this  reference  crbit 
will  be  stable  in  the  presence  of  small  disturbances  in 
either  the  orbital  plane  or   the  third  dimension,   and  these 
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disturbances   will      produce   oscillations    about      the    reference 
orbit    with    its    same    period,    i.e. 


\  as«- 


SAT 


B-        SATELLITE    GEOOND    TRACK 

The  earth-satellite  model  as  developed  in  Section  A  is 
obviously  over-simplified  for  the  purposes  of  target 
tracking;  thus  far,  the  Earth  has  been  represented  only  as  a 
point  mass  rather  than  as  a  spinning  globe,  which  would  make 
it  extremely  difficult  to  describe  any  motion  across  the 
Earth's    surface. 

One  intrinsic  feature  of  a  satellite's  orbit  used  in 
measuring  its  flight  path  is  the  inclination  angle  i,  which 
represents  the  positive  angle  between  the  orbital  plane  and 
the  equatorial  plane.  This  angle  can  be  used,  together  with 
earth's  surface  coordinates,  to  describe  the  path  over 
ground,    or    ground    track,    of    the   satellite. 

In  Figure  2.2,  the  Z  axis  coincides  with  the  Earth's 
polar  axis;  L  and  A  measure  ncrth  latitude  and  east  longi- 
tude respectively;  and  r,  §  ,  and  \  describe  the  satel- 
lite's   motion   in   its    orbital    plane    as  before. 

If  the  satellite  is  considered  to  have  originally 
orbited  in  the  equatorial  plane,  its  position  would  have 
teen    described    by 
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Figure    2.2         Inclination   of   the   Orbital   Plane 


If      the    orbital      plane      is    then      rotated      about      the    X      axi. 
through    i    degrees,    then   the    coordinates    are   transformed   by 

I  G  O     ~\ 

O  CO>     <-     — S*N*  t 


T 


•$,  o      u         CCS  C 


) 


that    is,    now 


"X    =       r  cos  (\>  , 

^Y7       -        -C    VN  4>      CcS  c 1 


(2.3) 


and   the    latitude   and    longitude    are    described   by 
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V    -    T7\n"1     ^  A — — — - 


A  = 


A   =   n\N 


I 


X 


(2.4) 


If  the  Earth  were  truly  a  stationary  sphere,  these  equa- 
tions would  be  sufficient  to  describe  the  satellite's 
motion.  Because  the  Earth  is  actually  spinning  under  the 
satellite,  however,  angular  rates  must  be  considered,  so 
that  the  Earth's  rotational  speed  (shown  as  o^,  in  Figure 
2.2)  may  likewise  be  considered.  Therefore  equations  2.3 
and  2.4  above  must  be  differentiated  with  respect  to  time  as 
follows    (note    that    i    is    time-independent) : 


?   - 
L  '- 
X  - 


—    <"  S  V  M  <fc>  § 

\f  Coi(t  CCS  t^, 
•C    Cc  5>  <$  SUM  u  $   , 


(2.5) 


(2.6) 


L 


Substitute    equations    2.5   into   eguations   2.6, 

COit|     Cob  L      <V 


(2.7) 


X 


cc^r4   4-     5^c<\,   cos'vl 
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Consider  now  that  the  Earth  is  rotating  in  an  easterly 
direction;  the  rate  at  which  east  longitude  is  traversed  by 
the  satellite  is  now  decreased  by  the  Earth's  rotational 
speed,    or 

COS  I  <\> 


\- 


CcS7(£  -\   Sn^^^COS^ 


LO, 


(2.8) 


Employing  equations  2.7  and  2.8  for  the  generation  of  lati- 
tude and  longitude  respectively  led  to  the  computer- 
generated  ground  tracks  shown  in  Figures  2.3  and  2.4  for  two 
typical  orbital  periods  (note  that  tne  inclination  angle  is 
60  degrees  in  both  cases). 
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Figure  2.3    Satellite  Ground  Track. 
For  a  Nominal  Period  of  Ninety  Minutes 
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Figure    2.4        Satellite   Ground    Track 
For    a    Nominal    Period   of    Twelve    Hours 


The  last  factor  that  must  b€  considered  to  achieve  abso- 
lute accuracy  in  predicting  the  satellite's  orbital  path  is 
the  non-spherical  shape  of  the  Earth;  to  wit,  the  Earth  is 
actually  a  slightly  oblate  ellipsoid,  which  causes  a  slow 
drift,  or  precession,  of  the  satellite's  orbital  plane 
around  the  Earth  with  respect  tc  the  fixed  stars.  [Bef.  5] 
includes  a  detailed  discussion  cf  the  effects  of  precession 
on  the  orbital  plane,  including  the  derivation  of  a  formula 
for  precession  rate,  which  is  offered  here  without  proof; 
for   a    circular    orbit, 
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which  appears  to  be  a  potentially  large  number,  but  as 
Figure  2.5  indicates,  is  actually  only  a  few  degrees  per 
day.  When  one  considers  that  the  typical  tracking  satellite 
makes  a  dozen  or  more  revolutions  of  the  Earth  daily,  the 
change  in  the  ground  tracks  of  Figures  2.3  and  2.4  would  be 
quite  small  for  each  revolutior;  further,  as  long  as  the 
satellite's  ground  station  is  aware  of  the  precession  and 
makes  compensation  for  it,  there  is  no  discernable  error 
introduced  into  the  target  tracking  problem. 
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Figure  2.5    Precession  Rates 
For  Various  Altitudes  and  Inclinations 


C.   EARTH  COVERAGE 

The   key  guantities   to  consider   when  discussing   Earth 
coverage   for  either   a  single   satellite,   or   an  array   of 
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satellites,  are  the  related  concepts  of  swath  width  and 
revisit  time  interval-  Swath  width  relates  directly  to  that 
area  viewed  by  the  satellite  as  it  passes  overhead;  revisit 
time  is  the  measure  of  how  frequently  a  particular  point  on 
the  ground  is  in  view  from  a  passing  satellite. 


Figure  2.6    Geometric  Swath  Width 


The  first  aspect  of  swath  width  to  be  considered  is  the 
maximum  viewing  angle,  or  Geometric  Swath  Width  (GSW) .  As 
shown  in  Figure  2.6,  this  is  the  maximum  viewable  area  by 
the  satellite,  and  is  related  tc  the  altitude  as  follows: 
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(2.9) 


or,    in    terms  of    distance, 
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(2.  10) 


Some  typical  values  fcr  GSW  are  shown  in  Table  II 
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TABLE 

II 

i 

GSV 

as  a  Function  of 

Altitude 

h 

e 

GSU 

150 

nm 

33.2° 

1995  nm 

600 

nm 

63. 4" 

3796  nm 

2250 

nm 

105.6° 

6338  nm 

5600 

nm 

135.3° 

8118  nm 

10900 

nm 

152.3" 

9136  nm 

19322 

nm 

162-7° 

9760  nm 

CO 

180J 

10800  nm 

The  second  aspect  of  swath  width  is  minimum  swath  width 
(MS7I)  required  for  coverage,  as  a  function  of  the  number  of 
revolutions  per  day.  Because  the  swaths  cut  by  a  satellite 
in  a  circular  orbit  are  most  widely  spread  as  it  crosses  the 
equator,  this  simply  means  computing  n,  the  number  of 
equator  crossings  per  day,  and  tnen  swath  angle  is  defined 
as 


wner  e 


so 
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(2.11) 
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es  -   (v.o 
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(2.12) 


Taking  into  account  both  the  ascending  and  descending 
trajectories,  the  typical  satellite  orbit  can  actually  be 
considered  to  cross  the  equator  twice  per  revolution  (see 
Figures  2.3  and  2.4),  and  so  /^  is  a  sufficient  swath 
width  to  ensure  coverage  along  the  entire  equator,  which  is 
of  course   a  worst-case  approach   for  achieving   coverage  of 
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the  entire  globe.  This  leads  to  the  information  summarized 
in  Table  III;  the  last  (geosynchronous)  case  is  obviously 
unrealistic  for  tracking  applications,  as  tiSW  is  greater 
than  GSW. 


TABLE 

III 

HSW  as  a 

Function 

of  Altitude 

h 

n 

©* 

MSW 

150  nm 

600  nm 

2250  nm 

5600  nm 

10900  nm 

19322  nm 

16 
13.  41 

8 
4 
2 
1 

11.25° 
13.47° 
22.5" 
45" 
90^ 
180 

675  nm 

808  nm 

1350  nm 

2700  nm 

5400  nm 

10800  nm 



The  overlap,  or  difference  between  Tables  II  and  III, 
determines  the  maximum  number  cf  times  a  single  satellite 
can  possibly  view  a  stationary  target  on  the  eguator  during 
successive  orbits.  This  numher  N  can  be  calculated  by 
dividing  twice  equation  2.10  by  equation  2.12,  or 
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Unfortunately,  average  time  between  revisits  cannot  be 
characterized  as  24  hrs/N,  as  successive  swaths  will  overlap 
on  consecutive  orbits,  and  then  the  target  will  not  be  illu- 
minated for  several  orbits.  At  this  point  it  is  necessary 
to  place  additional  satellites  in  the  orbital  pattern,  or 
constellation,  to  ensure  coverage  during  every  orbit,  i.e.  a 
minimum  of  360/GSW  (rounded  up)  is  required.  This  will  then 
provide  n  visits  per  day  to   the  equatorial  target,   where  n 
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is  again  as  defined  in  equation  2.11  .  Once  this  has  been 
achieved,  insertion  of  additional  satellites  will  only 
continue  to  increase  the  revisit  frequency  while  correspond- 
ingly   decreasing    the    revisit    time. 

The  last  factor  in  this  ievisit  time  problem  is  the 
consideration  of  horizon-to-horizon  coverage  along  the  path, 
that  is,  until  now  the  discussion  has  only  dealt  with  meas- 
uring the  time  between  successive  CPA's  (Closest  Point  of 
Approach)       of   the      satellite    to   the    target.  As    Figure    2.7 

indicates,  however,  the  target  is  actually  in  view  leng 
before  the  satellite  passes  overhead,  and  remains  in  view 
until    the   satellite    passes   over   the    far   horizon. 
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Figure   2.7        Target   Time-ir-¥iew   for   a   Single    Pass 


If    the      target    lies      directly    on      the    satellite's      path, 
then    the   maximum      viewing   angle    ©v  is    defined      in    Figure   2.3 
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Figure    2.8         Viewing   Angle 
This    translates    to    a    viewing    time   of 
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For  a  surface  target  and  a  satellite  at  150  nra  elevation, 
this    translates      to    a      time-in-view    of      8.3    minutes.  This 

viewing  time  will  increase  as  satellite  altitude  increases, 
and  decrease  as  the  target  moves  toward  the  oatside  of  the 
swath.  Regardless,  the  revisit  time  between  target  observa- 
tions  is   always    decreased   by    this    viewing    time. 

The  final  facet  of  ground  coverage  to  be  considered  is 
coverage  at  the  poles.  Having  used  the  Equator  as  the  worst 
case  for  swath  spreading,  one  mijht  then  expect  the  swaths 
to   converge   at    the    poles.         Actually,    the    convergence    of    the 
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ground  track  occurs  about  the  latitude  lines  of  the  angle  of 
inclination  because  they  are  the  circles  of  smallest  circum- 
ference to  be  viewed  from  directly  above;  hopefully  the 
swath  width  of  the  satellite  is  then  great  enough  to  overlap 
the  poles.  Thus  for  an  orbital  inclination  of  60  degrees, 
the  most  closely  grouped  locus  of  points  observed  from 
directly  overhead  are  the  latitude  circles  60°  N  and  60°  S. 
To  see  if  the  swath  overlap  will  at  least  cover  the  poles, 
Figure  2.9  must  be  considered-  A  is  the  half-angle  from 
eguation  2.9,  so 


Figure  2.9    Minimum  Inclination  for  Polar  Coverage 
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Table   IV   summarizes  these   results   for   typical   orbital 
heights. 
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TABLE    IV 

Minimum 

Inclination    for   Polar   Coverage 

h 

i 

150    nm 

73.4° 

60  0  nm 

53.4  ° 

2250    nm 

37.2° 

5600   nm 

22.4  ° 

10900    nm 

13.9  ° 

19322   nm 

,    _  

8.7  ° 

To  summarize  thus  far,  a  satellite  placed  at  an  altitude 
of  600  nm  would  be  useful  for  tracking  purposes;  its  GSW  of 
63.4  and  MSW  of  13.47  ensure  that  a  target  would  be  viewed 
on  at  least  four  (and  probably  five)  consecutive  passes,  and 
its  crbital  period  of  107.4  minutes  indicates  that  the 
target  would  be  viewed  frequently  enough  to  acquire  timely 
and  significant  information  about  its  location,  course,  ana 
speed.  Inclining  it  a  minimum  of  58.4  degrees  would  ensure 
coverage  of  both  pcles,  and  its  precession  rate  of  -3 
degrees  per  day  (or  about  -0.2  degrees  per  orbit)  would  not 
deter  its  ability  to  maintain  track  on  the  target. 
P.ealistically,  a  single  satellite  would  not  be  used;  the 
placement  of  a  minimum  of  six  in  the  constellation  would 
ensure  that  no  target  would  go  more  than  one  period  without 
being  observed,  and  the  placeirent  of  additional  satellites 
would  only  then  increase  the  frequency  of  target 
observation. 

D.        SATELLITE    ORIENTATION    IN    SPACE 

Having  developed  a  working  model  for  the  orbiting  satel- 
lite, the  next  phase  cf  the  problem  will  consider  the  satel- 
lite's   observation    of      its    target,       either    by      passive     (i.e. 
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IP.)  or  active  (i.e.  search  radai)  means.  First,  however,  a 
coordinate  frame  of  reference  for  that  observation  is 
required.  Thus  far  the  assumption  that  the  satellite  can  be 
represented  by  a  point  mass  has  sufficed;  now,  however,  it 
must  be  realized  that  the  satellite  has  dimension,  is  irreg- 
ularly shaped,  and  quite  possibly  undergoes  radical  attitude 
changes  throughout  the  course  of  its  orbit.  It  is  therefore 
imperative  that  the  satellite  be  able  to  orient  itself  with' 
reference  to  its  ground  point,  that  is,  the  point  on  the 
Earth's  surface  directly  between  the  satellite  and  the 
Earth's  center.  This  is  because,  realistically,  the  satel- 
lite will  be  measuring  (at  best)  a  line-of-sight  range  and  a 
series  of  angles  (prcbably  altitude  and  azimuth)  to  the 
target:  it   is      these    angles      that    must      be  oriented      with 

respect    to    the    reference   directions,      in    order   that    the    data 
fed    to    the    tracking    computer    be    consistent. 

In  considering  Figure  2.10,  Figures  2.10  (a)  and  2.13 
(e)  show  the  space  reference  orientation  and  the  satellite 
aligned  in  that  orientation;  Figures  2.10  (b)  ,  (c)  ,  and  (d) 
show  the  initial  position  and  intermediate  rotations  of  the 
satellite  axes  required  to  achieve  that  orientation.  It 
should  be  emphasized  that  these  rotations  are  computational 
rather  that  mechanical;  as  long  as  the  target  falls  within 
the  sensor's  coverage  area,  there  is  no  need  to  actually 
physically  rotate  the  satellite  into  any  new  position. 
Rather  the  target  coordinates  are  transformed  mathematically 
as    follows: 

Step    1.         Rotate   around    the   x      axis   by   '  \\      to    get    y    axis 
into    "NE"    plane. 
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Figure  2.10    Translation  of  the  Satellite 
To  the  Reference  Orientation 

Step  2.    Rotate   around  the  y  axis  by   U_  to   get  the  z 
axis  in  the  "D"  direction. 
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Step   3.         Hotate      aroand   th€   z    axis    by      \\     to 

j 

and    y    axes   aligned    in   the    "N"    a  rd    "E"    directions. 
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get    the   x 
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Thus    to    get   from    x-y-z   coordinates    to    N-E-D    coordinates,    the 
transformation    is 

-  T.-X-T 
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(2.  13) 
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Figure    2-11         Angles   Transformed   to    Rectangular    Coordinates 

There  is  actually  another  step  involved  both  before  and 
after  the  transformation  of  equation  2.13,  that  of  trans- 
forming from  the  angles  to  the  rectangular  coordinates  and 
back.  The  translation  from  an  initial  set  of  raw  anjuiar 
measurements  to  the  satellite's  x-y-z  rectangular  coordi- 
nates is  shown  in  Figure  2.11  .  The  corresponding  equations 
are 
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(2.  14) 


Meanwhile,  the  transformation  from  the  N-2-D  reference 
rectangular  coordinates  to  the  observed  angular  coordinates 
is  depicted  in  Figure  2. 12,  and  described  mathematically  by 
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It  is  worthy  of  note  that  R  remains  unchanged  by  ail  the 
transformations;  only  c^  and  g  change.  Thus  the  complete 
transformation        from  angles-ref erenced-to-sa tellite         to 

angles-referenced-to-ground    is 


and 


L 


£     CoS    /£, 


J 


(2.  16) 


£-~W7P7 


ty 


0(  -    TAN"'     £/m 


/5 


=      CoS 


*-     *l 


R. 


34 


■     - 

c^  -  /V£w\vm"vi  <\ni«lc  lu,c«.^,^-  ph&a*  ni 

/ 

/ 

/ 

£ 

b 

^JSTteU^T^      " 

0  k    ^  ^  / 

1 

.    . 

Figure  2.12    Rectangular  Coordinates  Transformed  to  Angles 
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Figure   2. 13        Observing    the   Target    from   Space 

E.        SATELLITE    OBSERVATION    OF    A     KEAR-SJRFACE    TARGET 

Equations      2.16    detail      the      realignment      of    raw      target 
information   along       the   space      reference   axes,         N-E-D;         the 
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Figure    2.14        Satellite- Tar get- Earth   Center    Triangle 

final  step  in  calculating  target  position  and  velocity  on 
the  Earth's  surface  is  to  translate  the  range  and  the  space 
angles  into  earth's  surface  coordinates,  i.e.,  latitude  an3 
longitude.  Figure  2.13  shows  the  pertinent  variables,  while 
Figure  2.14  shows  the  triangle  formed  by  the  satellite,  the 
target,  and  the  earth's  center.  The  latter  figure  presumes 
a  surface  target;  the  case  of  an  air  target  will  be 
discussed    momentarily. 

To  find  the  earth's  surface  distance  along  a  great 
circle  passing  through  the  ground  point  and  the  target's 
position,  one  need  only  find  the  earth-central  angle  yj  with 
the    law    of   cosines,    as   shown    in    Figure   2.14    , 
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and  then  the  arc  length,  or  surface  distance 
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Figure  2.15    Same  Triangle  for  an  Air  Target 


Note  that  the  angle  $  was  not  required  in  this  calculation; 
it  is  required,  however,  for  calculations  involving  an  air 
target  of  unknown  altitude,  as  shown  in  Figure  2.15  Solving 
for  the  target  height  requires  applying  the  law  of  cosines 
again : 
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and   then    ^    follows    from    the    law   of    sines 
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and    once   again,  /J{_  -   x~, 


In    either   case,       cnce    the    great    circle    distance   from    the 
ground    point   to    the    target      is    known,      the    target's   latitude 


37 


qp~Ls 


N*C'uT>-v        pfc  u  e. 


4g-L7 


u,xs 


Figure   2.16        Surface   Triangle    for   Target   Position 

and  longitude  may  be  calculated  by  using  the  spherical 
triangle  shown  in  Figure  2. 16  .  Using  the  law  of  cosines 
for  spherical  triangles,  and  realizing  now  that  it  is  actu- 
ally more  convenient  to  work  with  earth-central  angles 
rather    than   great   circle    distances,    then 

cc  (qc  -Lt)    -   cos  (cic  -L$)  cos^    r    Sv.m  (<-'\g-W)  r*,ivj  0  Go*  t<j 
or,    eguivalently , 
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Similarly, 
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cr,    solving    for   }L  , 
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and    finally 

AT  '-    As  +  71.  (2.23) 

It  should  be  emphasized  that  bcth  latitudes  are  referenced 
North  here,  and  both  longitude£  East.  To  switch  to  south 
latitude   and/or    west   longitude,    one    need    only   know 

For    N    lat    <    0,     S    Lat    =    -N    Lat  ; 

For    E    Long    <    0,    H    Lone   =   -E   Long; 

For    E    Long    >    180,    W    Lcng    =    360    -    E   Long  „ 

Sample  calculations  using  these  equations  reveal  that  it 
takes  a  significant  amount  of  target  elevation  to  generate 
an  appreciable  change  in  /S  ,  i.e.  at  a  range  of  1000  nm  from 
a  satellite  at  elevation  600nm,  a  target  flying  at  25000  ft 
would  have  a  p  angle  only  0.2  different  from  that  of  a 
surface  target.  Therefore,  depending  on  its  sensitivity, 
the  satellite  sensor  may  or  may  not  distinguish  betwen 
target  types,  if  dependent  ce  a  single  look  at  position 
only.  The  necessarily  greater  speed  of  the  air  target, 
however,  will  ultimately  becoie  obvious  if  the  satellite 
system  is  either  capable  of  calculating  range  and  bearing 
rates  based  on  multiple  observations,  or  else  rate  informa- 
tion is  an  intrinsic  part  cf  the  single  observation. 
Therefore,  this  model  must  provide  for  the  satellite's 
ability  to  observe  R ,  oc  ,  and  fi  in  addition  or  as  opposed 
to  R,  oC  /  and  A  .  The  transformation  equations  2.14  through 
2.23  must  then  be  differentiated  with  respect  to  time  to  get 
the  range  and  bearing  rates  referenced  to  N-E-D,  and  then 
the    target's   latitude,    longitude,    and   altitude   rates. 

Differentiating    eguations    2.14, 


i  -    k  COS/   -    fc£  -5^/L 


(2.24) 
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This  gives  rate  of  change  or  the  target's  coordinates 
referenced  to  the  satellite's  axes  and  based  on  the  target's 
motion;  if  the  satellite  can  instantly  fix  its  position  in 
space,  then  x-y-z  can  be  transformed  to  N-E-D  by  applying 
the  transformation  equation  2.13  to  correct  for  satellite 
attitude.  If  the  satellite's  own  rate  of  rotation  around 
its  three  axes  is  taken  into  account,  however — i.e.  the 
satellite  is  tumbling  fast  enough  to  affect  significantly 
the  observed  angular  rates--then  that  transformation  2.13 
must    also   be   differentiated,    i.e. 
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In    the   next   step,      equations      2.15   are    differentiated    to 
obtain  tt 
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Having  transformed  the  raw  rate   data  to  the  reference  coor- 
dinate rates  with  equations  2.24   through  2-26,   these  rates 
are   then   translated   to   earth's   surface   coordinates   by 
differentiating  equations  2-17  through  2.23  . 
Then,  from  2.17  (surface  target), 


from  2.  18  , 


u;  = 


(2.27) 


(2.28) 


from  2.19  (air  target), 


/>* 


G".-Wy  coy^ 


and  in  either  case,  (%■  -  ^„J> . 

Prom    2. 20    , 


(2.29) 


(2.  30) 


and    from   2.2  1    through    2.23    , 
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.A, 


(2. 31) 


These  equations  2.24  through  2.31  completely  define  the 
derivation  of  target  latitude  and  longitude  rates  based  on 
raw  angular  and  range  rate  data  available  at  the  satellite. 
If  applied  sequentially  by  a  computer,  the  target's  rate  of 
travel    could  easily    be   calculated. 
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This  completes  the  description  of  the  recorded  data 
available  from  the  orbiting  satellite  and  its  observation  of 
a      near-surface    target.  The    next      chapter      is    devoted      to 

reconstructing  the  target's  motion  from  this  information; 
this  will  then  lead  to  the  observability  analysis  of  Chapter 
IV. 
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Ill-  TARGET  MOTION 

It  is  henceforth  assumed  that  the  satellite's  position 
and  orientation  in  space  are  known,  and  thus  observed  target 
data  can  be  translated  into  ground  coordinates  in  accordance 
with  the  discussion  presented  in  the  last  two  sections  of 
Chapter  II.  This  leaves  the  problem  of  reconstructing  the 
target's  motion  from  the  observed  data.  With  an  eye  toward 
the  observability  analysis  upcomimg  in  Chapter  IV,  an  effort 
will  be  made  to  employ  a  linear  target  model,  while  the 
observations  will  be  necessarily  highly  nonlinear.  The 
alternatives  would  be  nonlinear  equations  describing  both 
the  target's  motion  and  the  observation,  or  a  nonlinear 
plant  with  a  linear  observation  achieved  by  another  coordi- 
nate transformation,  both  of  which  would  only  further 
complicate  the  problem  at  this  point.  They  do  present 
viable  possibilities,  however,  which  might  be  investigated 
as  part  of  a  search  for  convenient  coordinates  conducive  to 
appropriate  nonlinear  observability  analysis  and  tracking 
design. 

A.   TARGET  MOTION  RECONSTRUCTED  FROM  SATELLITE  DATA 

In  Chapter  II,  algorithms  were  developed  for  trans- 
forming raw  satellite  sensor  information  into  ground  coordi- 
nate data;  given  range  and  hearings,  the  computational 
result  is  target  latitude  and  longitude.  If  range  and 
bearing  rate  information  is  also  available,  the  result  is 
then  latitude  and  longitude  rates. 

To  reconstruct  the  target's  motion  from  this  information 
is  fairly  straightforward.  The  first  step  is  to  translate 
the  latitude  and  longitude  into   linear  distances,   and  then 


43 


—  1 

1* 

/ 

L -■            i 

(c,o) 

e 

► 

...    

..    _..  i 

Figure  3.1        Earth's  Surface   Projected   onto  Cartesian    Grid 

compute  the  velocity  components  if  they  are  not  readily 
available.  If  the  €arth's  surface  is  projected  upward  onto 
a  Cartesian  Grid  with  its  origir  at  (L,  \  )  =  (0,0)  as  in 
figure  3.1,  then  a  position  (n,e,hT)  would  be  described  by 
equations   3.1,    with    h     unchanged    from   Chapter    II. 


e  -  r0  \T  co-iLT 


(3.1) 


If  rate  data  is  available  from  the  satellite,  then  the 
northerly  and  easterly  velocity  components  are  computed 
simply  by  differentiating  equations  3. 1  with  respect  to 
time;     obviously,    h^    is    once    again   as    in    Chapter    II. 

c 


^t   '-     «     -      Vj  ^t   Cc*L<  -    AtLjS-m  lt 


(3.2) 


uu 


On  the  other  hand,  if  rate  data  is  not  immediately  avail- 
able, the  next  position  observation  is  required,  and  the 
velocities  at  time  k  are  approximated  by 


vj6  M  -     t£CvA  -       elW\  -  <^uj 


i 


in 


^       (_yA      =  V\TM   -  W    Q~^ 


either    case,    then    velocity       \J    -    1  V^  *\lE    1     f 


(3.3) 


and   course  (V)   =  tam"1         A 

as  shown  in  Figure  3.2  .  For  ar  aircraft  flying  at  constant 
altitude,  h7  will  be  zero;  for  a  surface  target,  both  hT  and 
hT  will  be  zero.  Otherwise,  this  first-order  model  allows 
for  nonzero  velocities  in  the  n ,  e,  and  hT  directions.  To 
avoid  the  necessity  tc  include  any  higher  order  variables  in 
the  target  description,  the  model  will  represent  accelera- 
tion as  the  control  vector  u(t)  in  all  further  discussion  of 
the    target's   performance. 

E.       SATELLITE    DATA    OBSERVED    ?HOK   TARGET    iiOTIOH 

Thus  far,  the  result  of  the  discussion  in  Sections  IID, 
HE,  and  IIIA  of  this  report  effectively  has  been  to  develop 
an  algorithm  for  describing  the  motion  of  a  near-earth 
target,  given  the  parameters  of  the  orbit  of  the  tracking 
satellite   and      the    observed      target    data.  No    matter      what 

method  of  analysis  is  employed,  however,  any  observability 
study  requires  first  a  target  model,  and  then  some  series  of 
observations      based    on      target    hehavior;         therefore    it      now 
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Figure   3.2        Resolution   of   the   Velocity  Components 

becomes  necessary  effectively  tc  work  backwards  through  the 
equations  of  those  three  previous  sections  and  develop  a 
system  of  equations  that  feature  the  target  as  the  plant  and 
the    satellite    as    the    observer.  It    would    of  course    greatly 

facilitate  the  observability  analysis  if  both  the  plant  and 
observer   for   the    system    could   be   linear,    and   take   the    form 

X(t)     =    Ax(t)    +    Bu(t)  , 
y(t)     =   Cx(t). 

In  that  case,  the  observability  study  of  Chapter  IV  would 
become  straightforward,  and  this  aspect  of  this  problem 
would  no  doubt  have  been  fully  explored  years  a^o. 
Unfortunately,  as  the  complicated  angular  rotations  and 
spherical  geometry  of  Chapter  II  portend,  there  is  no  real- 
istic way  to  pick  variables  sc  that  the  problem  will  be 
fully  linear.  It  remains  then  to  experiment  with  either  a 
linear  plant  and  nonlinear  observer,  or  vice  versa;  it  would 
ultimately  be  advantageous  to  avoid  if  possible  the 
completely    nonlinear    system    described   by 

X(t)     =    F{x  (t)  ,u  (t),t), 
y(t)    =    H  (x(t)  ,t)  . 
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Now,  the  discussion  of  Chapter  II  essentially  derives 
the  system  equations  for  describing  a  target's  motion  in 
terms  of  space  coordinates;  however,  to  have  a  near-earth 
target  described  in  terms  of  S,  c\  /  3  *  an^  their  deriva- 
tives would  not  necessarily  be  useful,  as  it  would  require 
all  the  coordinate  transformations  of  Chapter  II  to  be 
performed  over  again  to  relay  any  useful  information  to  the 
ground.  In  addition,  the  presumption  of  a  constant  (in  the 
absence  of  control  input)  course,  speed,  and/or  rate  of 
climb  (air  target)  would  be  mathematically  impossible,  since 
these  coordinates  would  not  be  available;  therefore,  since 
assuming  constant  R ,  o(  ,  and  /£  would  still  not  achieve 
constant  VN  ,  V-  ,  and  hT,  the  second  derivatives  of  E,  d  , 
and  $  would  be  required,  i.e.  the  differentiation  of  equa- 
tions 2.24  through  2.31  .  To  avoid  this  unnecessary  compli- 
cation, the  reverse  derivation  will  be  performed  here,  i.e. 
a  description  of  both  target  motion  and  space  observation  in 
terms    of      earth's    surface   coordinates.  The   model      will    be 

derived  for  the  most  general  case,  i.e.  all  variables  non- 
zero. The  constant  altitude  aircraft  or  surface  target  will 
be    considered    simply    to   be   special   cases    of   this. 

1 .      Target    Model 

If  the  target  is  presumed  to  maintain  a  constant 
course  and  speed  in  the  absence  of  a  control  input  (acceler- 
ation) ,  a  simple  one-dimensional  model  might  take  the  form 
of 


x(4  = 


O     \ 

o  o 


x(0   * 


o 


u 


ti, 


where  u  (t)  can  actually  be  either  system  noise  or  an  accel- 
eration. Since  three  mutually  perpendicular  coordinates  are 
required  to  describe  the  target  position,   the  system  should 
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have    six   state    variables,       defined      by    the    quantities    devel- 
oped   in   Part   A    of    this   chapter    as   follows: 


x,    =  n    =   northerly   distance    traveled     (nm) , 

x x  =  n    =    Vu    =    Vcos<ty  =   northerly    velocity     (kts) , 

Xj  =  e   =    easterly    distance    traveled    (nni)  , 

xA  =  e    =    V£    =    VsincJ>  =   easterly   velocity     (kts)  , 

x  i  =  hT=   altitude    above    earth's    surface    (iim)  , 

x0  =  hT=    rate   of   climl    (kts); 

and  negative  values  for  these  variables  represent  southerly 
distance,  southerly  velocity,  westerly  distance,  westerly 
velocity,  (no    negative      altitude)  ,      and      rate    of      descent, 

respectively.       For    a    surface    target,    x5-    and   xb    are   zero;    for 


a  constant-altitude    air   target, 
thus    modeled   continuously   by 


is    zero, 


The    target    is 


K 


W 


*  O  V  O  G  C  O 
O  O  O  GOO 
GOO     V    GO, 

OOOCGOI- 
0      C    O     G   O    \ 
GOO    G    G  G 


o 

G  O 

\ 

0    G 

o 

O  G 

o 

V   G 

c 

G  G 

o 

O    I 

_ 

uiM 


(3.4) 


where  u  (t)  represents  either  noise  in  the  n-e-h  system,  or 
else  acceleration  in  the  three  directions.  Realistically, 
because  computation  requires  a  finite  time  and  one  satellite 
cannot  normally  be  dedicated  sclely  to  observing  a  single 
target,  the  observations  will  necessarily  be  discrete,  and 
hopefully  periodic  in  time  T.  The  discrete  model  analogous 
to    that    of    equation    3.4    is 
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Assuming  that  external  nonlinear  forces  such  as  wind  or  sea 
drag  are  either  negligible  and/or  unpredictable,  this 
completes  the  target  model. 

2 .   Sat alii te  Observation 

The  observer  matrix  H  will  obviously  be  a  nonlinear 
operator  on  the  state  vector.  To  begin  its  derivation,  the 
n-e-h_  coordinates  must  be  transformed  to  latitude- 
longitude-altitude  coordinates  by  solving  equations  3.1  in 
reverse  ,  and  then  differentiating  as  follows: 
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*-T  ^- 


^T*      rest,      .     Xt 


■e  ccstT  -v  eCi  SinJU 


Yi   ccszL-t 


(3.6) 


The    ultimate   goal   of    this      transformation    will   be    to    express 
the    space   observations  in    terms   of    the   state   vector,    i. e. 

ft" 

ft 
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First,      however,       it    is    useful    to      calculate   in    terms   of    the 
state    vector   the    intermediate    variables    ?6    and ^    ,       as    they 


were      defined      in      Figure    2.16 

trivial:  t         \ 

X  =-    At'  As    , 

7C   =     At    -  K  - 


Solutions      for      ?6      are 


(3.3) 
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To      solve   for 
follows: 


and    /?    ,       equation      2.21       is   rewritten      as 
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U'    (<^L-  s>n^  CoSTt.  -   Si>ALTCc^L^  *  >cccSLT  Cu^^!,,^7<J.  (3.  10) 

Enough  information  is  new  available  to  solve  for  the 
space  coordinates  R,  (X  /  /o  *  and  their  derivatives.  To 
obtain  R,  the  law  of  cosines  is  applied  to  Figure  2.  15  as 
follows: 
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To    obtain   E#    consider 
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To    obtain  iX  ,         the    law    of    sines   for      spherical    triangles  is 
applied    to    Figure    2.16    as   follows: 
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so 


1 


OL^s*-* 


Cos  U  S\^>u 


(3.  13) 


To    obtain    oC  ,    consider 
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To   obtain   /o,      the    law   of   cosines    is    again    applied    to    Figure 
2.15,    this   time    yielding 


so 
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(3. 15) 


To    obtain    A  ,    consider 


(3.  16) 


or 

The  observation  model  is  summarized  in  Figure  3.3  .  Any 
realistic  computational  procedure  would  of  course  use  the 
intermediate  variables  L,  X  ,  7C  ,  z^  ,  and  their  deriva- 
tives; for  the  sake  of  completeness,  however,  it  should  be 
noted  that  the  observer  functions  could  be  written  as  func- 
tions cf  the  original  state  vector. 
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Figure  3.3    Suiiaary  of  State  and  Observer 
Equations  Including  Intermediate  Variables 
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3-   Two  Simpler  Cases 

The  significant  complexity  of  these  equations 
suggests  that  some  simpler  representation  of  the  system 
might  he  useful  in  the  observahility  analysis,  if  only  to 
test  the  method  prior  to  its  employment  on  the  system  of 
Figure  3.3  .  One  approximatioi  might  be  to  presume  for  the 
moment  that  the  satellite  is  directly  overhead  the  target, 
and  that  relative  motion  between  them  is  arbitrarily  small 
enough  that  the  Earth  is  approximately  planar  beneath  it; 
for  the  trigonometric  functions, 


TiW/5  =  5^/3  ^/S 


and 


ccS^=  1 


o.  SATeu^-rc 

.- 
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J 

Figure  3.4    Satellite  Directly  Overhead  the  Target 

If  one  considers  that  fcr  a  satellite  directly  over- 
head the  target  as  shewn  in  Figure  3.4, 

Lr=  U,  Xt-  As,    and   hT  --    W%-R. 
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Figure  3.5 


Perturbation  About  the  Observation 
From  Directlj  Overhead 
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Figure  3.6    Resolution  of  Beta  Alony  the  N-E  Axes 

then  fcr  a  satellite  nearly  overhead  the  target,  the  probxem 
can  be  considered  as  a  perturbation  about  the  directly  over- 
head case.   In  Figure  3.5,  let 
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To  fully  linearize  the  problem  ,  it  turns  out  that  A  must 
be  eliminated;  this  can  be  done  (in  this  special  case  only) 
as  shown  in  Figure  3.6: 
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Now    the    observation    may    be    defined    by 
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(3.20) 
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and  the  corresponding  discrete  system  plant  is 
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with  the  same  observer  matrix  as  above  but  with  values  taken 
only    at    discrete    points   in    time. 

Experimental  computations  show  that  for  a  satellite 
at  altitude  600nm  and  a  target  at  less  than  60^  latitude, 
these  approximations  yield  about  one  percent  error  or  less 
for  /$>  less  than  5  ;  however,  the  maximum  possible  over- 
head time  during  which  this  model  applies  is  about  20 
seconds.  It  follows  then  that  this  sort  of  observation 
could  only  be  made  a  very  few  times  during  the  satellite's 
revolution,  severely  limiting  the  real-world  usefulness  of 
this  linear  model.  For  the  purpose  of  examining  the  observ- 
ability of  the  target  under  these  conditions,  however,  the 
model   should   still    prove    guite    useful. 

The  other  simplified  model  that  might  be  instru- 
mental in  gaining  some  insight  into  the  method  of  the 
observability  analysis  is  the  simplest  nonlinear  case,  i.e. 
the  satellite  tracking  a  fixed  point  on  the  earth's  surface. 
Simplifying  the  eguations  3.5  through  3.16  yields  the  system 
depicted  by    the    equations    in    Figure    3.7 

This  completes  the  various  derivations  for  all  the 
target    models. 
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Figure  3.7    Equations  for  Tracking  a  Fixed  Target 
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IV.  TARGET  OBSERVABILITY 

This  Chapter  is  subdivided  into  three  major  sections, 
specifically  the  observability  analyses  of  the  three 
different  target  models  developed  in  Chapter  III.  First, 
the  linearized  model  will  be  analyzed  by  the  method  of 
[Ref.  2],  and  then  the  stationary  target  and  the  general- 
case,  nonlinear,  moving  target  will  be  analyzed  by  the 
method  developed  in  £Ref.  1 ]. 


A. 


OBSERVABILITY  OF  THE  LINEARIZED  MODEL 


For  convenience1  sake,  the  linearized  model  has  teen 
subdivided  into  four  cases,  nanely  surface  and  air  targets 
with  discrete  and  continuous  modeling  for  each.  The  method 
of  [Ref.  2  ]  is  the  formation  of  the  observability  matrix  G 
from  the  system 

o 

x  =  Ax  +  B  u 

A.  —         *  - 

y  =  Cx 


such  that 


for  n  observations,  and  for  system  observability,  G  must  be 
nonsingular.  In  the  following  derivations,  the  minimum 
amount  of  information  necessary  for  observability  is 
considered. 

1  •   Surface  Target  Continuous  Model 

The  system  model  is 
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For  a  single  look, 
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is    required;    then  q^     \t*\l?C-^\  »  CT ' -- 

For    two    or   more    looks, 
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is  required,  and 
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For  the  next  observation,   A    =0,    so  there  is  no  need  to 


take  the   process  any  further.    If   only  position   observ- 
ability is   desired,   rather  then  full   state  observability, 


then 


r> 


1  = 


A 


is  enough  even  for  only  a  single  observation. 
2 •   Sur f ac e  Target  Discrete  Mode 1 


Now  the  system  model  is 
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is  reguired,   and  G   =  C   just  as  before.    For   two  or  more 
looks,  ['  .  ,s  "1 

is  reguired,  and 

G  -  Li 

which   simplifies   easily   to  the   same   nonsingular   matrix 
obtained  in  the  analogous  continuous  case. 

Obviously  for  this  simplified  case,  the  transition 
from  continuous  to  discrete  modeling  made  no  difference;  it 
has  been  implicitly  assumed  that  the  discrete  samples  are 
taken  often  enough  that  all  maneuvers  (i.e.  accelerations) 
are  observed,  in  accordance  with  the  Sampling  (or  Shannon 
Information)  Theorem  familiar  from  communications  applica- 
tions- Otherwise,  observability  will  decrease  significantly 
as  information  about  the  target  is  lost. 

3.   Air  Target  Continuous  Mcdel 

The  system  is  now  modeled  by 
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is  required,  and  G  =  C   as  in  the  surface  target  cases.   For 
two  or  more  looks, 
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is    required,    and 
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for  complete  observability.   As  in  the  surface  case,  if  only 
position  observability  is  desired,  then 
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P* 

A 


is   adequate   even    with   only    the    single   observation. 
^  *      ^.LL   1ALSL&1   Discrete    Model 
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is    required,    and   as   expected,    G    =   C      again.      For    two    or   more 
looks , 


y  W  = 


fil 
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is    needed,    and 
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which   simplifies      to    the    same      ronsingular    matrix    as      in    the 

continuous  case.         Again,      the    assumption    has   been    made    that 

information   is    sampled   at   the    minimum    (i.e.      Nyquist)       rate, 

which    is   twice    as   often   as    the    target's    highest    frequency    of 

maneuver. 


B. 


BCNLIBEAR    HODEL    CF    THE    STATIONARY    TARGET 


Applying  the  method  of 
briefly,  concerns  primarily 
matrix    defined    by 


£Ref.    1],         summarized      here 
the      analysis      of    a      Jaccbian 
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for  each  observation  of  an  n-sy£tem.  A  nonzero  determinant 
will  show  that  all  the  states  ir.  x  are  connected  to  at  least 
one  of  the  measurements  y,  and  so  an  inverse  function  exists 
such  that 
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x  =  H  (y) 


For  observability,  however,  this  mapping  of  y  hack  into  x 
must  he  one-to-one,  so  that  a  particular  series  of  measure- 
ments y  will  always  determine  a  unique  initial  state  x  (to )  . 
This  requirement  is  satisfied  if  a  second  condition  is  met, 
i.e.  J  must  be  positive  or  negative  definite,  and  the 
mapping  unigue  with  finite  covering.  The  complete  procf  of 
these  concepts  is  presented  in  [Ref.  1]  and  [Ref.  7].  For 
multiple  observation  variables  (i.e.  numbering  m) ,  an  n  x  in 
matrix  is  formed;  if  any  n  x  n  matrix  can  be  extracted  that 
satisfies  these  conditions,  the  system  will  be  observable. 
For  the  six-variable,  six-observation  case  upcoming  in 
Section  C  of  this  chapter,  this  will  lead  to  a  great  many 
possibilities  and  problems,  but  for  the  two-variable  case  of 
this  section,  the  method  should  prove  very  useful.  The 
approach  will  be  to  first  consider  each  observation  sepa- 
rately, and  then  in  combination. 

Starting  from  the  equations  for  the  observation  of  the 
stationary  target  decicted  in  Figure  3.7,  derivation  of  the 
Jacobian  matrix  for  y  =  R  is  accomplished  by  means  of 
implicit  differentiation  alone  the  lines  of  functional 
dependency  depicted  in  Figure  4.1  .  Consider 
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Figure  M- 1    Functional  Relationship  of  R  and  R  to  n  and  e 


Thus  the  Jacobian  matrix  for  R  is  written 
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Simplification    of    the   determinant   results    in 


Substitute   for    the    quantity    in    brackets: 
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which  is  obviously  ncnzero  in  the  general  case  but  may  well 
have  multiple  solutions.  Eased  on  the  criteria  just 
defined,  this  indicates  that  bcth  states  in  x_  are  connected 
to  the  observation  R,  but  the  connection  may  very  well  not 
be  one-to-one;  some  further  analysis  is  obviously  required. 

The  determinants  of  the  J-matrices  for  each  of  the  other 
observed  variables  may  well  prove  similarly  ambiguous; 
considering  the  observed  variables  in  combination  and 
attempting  to  establish  nonsingularity  and  positive/negative 
definiteness  of  the  resultant  nyriad  of  Jacotians  may  well 
prove  difficult  in  the  extreme,  if  only  in  the  sense  of 
requiring  a  copious  amount  of  ccnfusing  algebra.  While  the 
basic  geometry  of  the  problem  as  developed  in  Chapter  II 
leads  one  intuitively  to  the  conclusion  that  a  surface 
position  can  be  uniquely  established  if  either  {  oC,  A  )  or 
(R,oO--but  not  (R#/c3) — data  are  available,  demonstrating  it 
by  this  method  proved  a  mammoth  computational  undertaking. 
Needless  to  say,  when  the  protlem  is  expanded  to  the  four 
variables  of  the  moving  surface  target  and  then  the  six 
variables  of  the  air  target,  the  algebra  worsens  several 
times  over.  The  only  alternative  seemed  to  be  a  transforma- 
tion of  coordinates,  specifically  to  a  rectangular  system, 
so  that  the  differentiation  could  include  some  polynomials 
instead  cf  only  trigonometric  functions.  The  transformation 
is  accomplished  as  fellows:  establish  a  plane  at  a  distance 
equal  to  (hs-  -hT)  below  the  satellite  perpendicular  to  the 
vector  connecting  the  satellite  to  the  earth's  center, 
determining  in  effect  the  target's  horizon.  For  a  surface 
target,  the  point  of  intersection  is  the  satellite's  ground 
point;  for  an  air  target,  the  intersection  is  h  above  the 
ground  pcint.  Then  the  target's  position  is  projected  up 
into  the  tangent  plane,  as  shown  in  Figures  4.2  (a)  and  (b)  . 
It  is  now  possible  to  establish  the  relative  coordinates  as 
follows: 


65 


X- 


A 
Y\ 

It 
u 


L 


■SArrevuTe 


:SA>T£uuvt£ 


Figure  4.2    Projecting  Target  Position 
Into  a  Perpendicular  Plane 


As  every  set  of  true  target  coordinates  yields  a  unique  set 
of  relative  coordinates  for  a  particular  satellite,  the 
mapping  into  the  Cartesian  coordinates  is  one-to-one,  and  an 
observable  target  in  one  systeii  will  te  observable  in  the 
other.  The  complete  set  of  state  and  observer  equations  in 
this  coordinate  system  is  as  illustrated  in  Figure  4.2  (b) 
and  summarized  in  Figure  4. 3  -  For  the  special  case  of  the 
stationary  surface  target,  the  system  simplifies  as  follows: 
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O 
The  plant  equation  is  unchanged,  and  the  observations  are 

^*  -  oC  =   r\e  -  e  vv 
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Since  only  position   is  of  interest,   the   Jacobian  matrices 
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After  seme  simplification, 
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Figure    4.3        State    and  Observer    Equations 
For    the   Cartesian    Version    of    the    Problem 


V  3  A  ^  7^  6te  -eft) 
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which  is  again  nonzero  in  the  general  case,  and  which  will, 
on  reflection,  lead  to  a  unique  solution  for  any  particular 
target  and  a  specified  satellite;  in  fact,  equation  4.1 
should  then  also  yield  unique  sclutions,  not  just  due  to  the 
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one-to-one  correspondence  of  the  coordinates  and  the  observ- 
ability problems,  but  also  due  to  the  physical  reasoning 
illustrated   in    Figure   4.4    . 


Figure    4.4         Tracking    the   Stationary  Target 


The  satellite's  ground  track  is  a  curve,  and  there  is 
only  one  possible  point  of  intersection  of  even  three 
circles  whose  centers  lie  upon  it.  This  observability  will 
be  more  clearly  demonstrated  if  the  single  observed  variable 
to  the  stationary  target  is  ol  ;  obviously,  the  intersecting 
lines  of  bearing  must  define  a  single  point.  Further,  since 
for  a  surface  target  every  R  defines  a  unique  /o  and  vice 
versa,    the    A  -only    case    should    be   observable  also. 
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Consider  first    the    ,^-only    case: 
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The  numerator   is  identical  to   that  of  the   J(  determinant; 
Figure  4.5  illustrates  the  situation  here. 
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Figure  4.5    Azimuthal  Bearing-Only  Track 
Of  the  Stationary  Target 
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For    the   record,     in   the   /^-only    case, 
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(4.4) 


So  again  the  same  fcrm  of  determinant  will  be  achieved, 
albeit  with  a  different  multiplicative  constant.  Thus  for  a 
target  known  to  be  stationary,  the  observation  of  any  of  the 
guantities  R,  OC  ,  or  fi  is  enough  to  fix  its  position. 
Presumably  the  same  result  couid  have  been  achieved  in  the 
original  coordinate  system  had  the  algebra  been  carried 
through. 


C.   HCH1INEAR  MODEL  OF  THE  GENEEAI  TARGET 

Once  the  target  is  permitted  to  move,  of  course,  the 
unique- intersection  arguments  just  developed  no  longer 
apply.  The  equations  shown  in  figure  4.3  now  are  pertinent, 
but  J   is  defined  by 


X- 


a^x  o^x. 


2* 


The  derivation  of  the  Jacobian  matrices  and  their  determi- 
nants is  now  a  major  project  ir.  itself,  but  it  follows  the 
same  pattern  previously  established.  In  the  interests  of 
brevity,  the  requisite  algebra  is  excluded  from  this  discus- 
sion, but  included  in  this  report  as  Appendix  A.  After 
simplification  by  row  reduction,  the  J  matrices  are  as  shown 
in  Figure  4.6  ,  with  the  Ji,  and  H"  terms  as  specified  in  the 
appendix.    Further   simplification  of  the   determinants  may 
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well  be  possible,  but  these  representations  should  suffice 
here.   It  is  obvious  from  the  occurence  of  the  zero  rows  and 

columns  that  all  the  determinants   excluding  those  of  J  ,  and 

«- » 

J  are  zero:  computation  of  these  last  two  determinants 
proves  them  to  be  zero  also.  Considering  the  observed  vari- 
ables in  combination,  it  would  seem  that  some  variable  in 
addition  to  E  or  E  is  always  necessary  for  observability,  as 
they  have  the  only  Jacobian  matrices  with  zero  rows.  Fhile 
the  possible  combinations  of  six  columns  out  of  the  thirty- 
six  are  so  numerous  (approximately  two  million)  that  it  is 
virtually  impossible  to  explore  them  all,  only  one  combina- 
tion with  a  nonzero  determinant  and  positive  or  negative 
definiteness  is    required    for   observability. 

What  one  would  expect,  based  on  the  insight  gained  in 
Chapters  II  and  III  from  the  mathematics  of  the  derivation 
of  the  model,  is  that  any  combination  including  ol  or  U  and 
at    least   one   position   variable     (i.e.  E    and     ot ,     oC    and  /$ , 

etc.)  should  be  observable,  and  that  any  determinant  formed 
from  a  combination  of  columns  from  the  appropriate  J 
matrices  should  prove  it  (excepting  of  course  the  zero 
columns  in  the  od  and  oi  matrices)  .  The  combinations  of 
E,  E,  /$  ,  and  /?  should  however  prove  unobservable  for  the 
reason  of  a  lack  of  positive/negative  definiteness,  that  is, 
an  ambiguity  of  target  track  resulting  when  reconstruction 
of  the  initial  state  is  attempted  from  the  measurements.  To 
prove  this  condition  true  for  each  of  the  approximately 
130,000  possible  matrices  is  however  obviously  an  unreal- 
istic   undertaking. 

One  slightly  simpler  case  cf  particular  interest  might 
be  that  of  the  surface  target,  which  involves  the  first  four 
rows  by  four  columns  in  each  matrix.  If  the  accelerations 
are  nonzero,  all  the  Jacobians  except  E  have  nonzero  deter- 
minants. The  R ,  d  ,  fi  ,  and  fi  determinants  are  not  posi- 
tive   or    negative      definite,       indicating    that    there      is    still 
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Figure  4.6    Jacobian  Observer  Matrices 
For  the  Six  State  Variables 
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some  ambiguity  in  the  observations  and  so  the  target  is  not 
observable.  In  the  case  of  the  o^  Jacobian,  however,  it  is 
positive  definite,  i.e.  the  X  terms  drop  out  and 

\^\  -  (ea„,-f\acj  (4.5) 

This  indicates  that  a  maneuvering  surface  target  is  observ- 
able when  azimuthal  bearings  only  are  observed;  this  case 
corresponds  very  closely  to  the  two-dimensional  bearing-only 
tracking  problem  long  familiar  to  submariners.  If  the  target 
does  net  maneuver,  then  the  o(.  Jacobian  becomes  non- 
singular  and    the    target    is    unobservable,       and   then    more    than 

» 

one  variable  of  observation,  to  include  q^  or  x  /  is 
required  for  observability. 

It  becomes  obvious  why  the  observability  of  nonlinear 
systems  has  long  been  considered  a  highly  difficult  problem. 
At  least  as  much  insight  was  gained  into  the  problem  from 
its  mathematical  derivation  as  from  the  application  of  this 
method  of  observability  analysis.  One  area  in  which  the 
method  might  also  be  useful  is  in  evaluating  the  sensitivity 
of  the  system  observability  to  fluctuations.  Specifically, 
the  terms  in  the  ft  Jacobian  are  each  smaller  than  the  x  or 
B  terms  by  a  factor  of  l/ln^+e7"  ,  which  would,  in  the  general 
case,  mean  a  difference  of  three  orders  of  magnitude.  This 
would  certainly  lead  cne  to  presume  that  the  system  would  be 
more  sensitive  to  fluctuations  in  /$    than  in  R  or  X  • 

To  summarize  thus  far,  the  geometric  derivation  of  the 
coordinates  in  Chapter  II  leads  one  to  believe  that  ail 
three  coordinates  R,  X  ,  and  $  ,  or  the  derivatives  of  no 
more  than  two  of  them,  are  necessary  to  reconstruct  the 
target  motion  in  the  most  general  (air  target)  case,  while 
either  the  (B.,vC  )  or  ( o(. ,  £  )  combination  is  necessary  and 
sufficient  for  the  surface  target.  Examination  of  the 
linearized  model   in  this  chapter   tended  to   validate  those 
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insights;  then  the  examination  of  the  stationary  surface 
target  led  to  the  coordinate  transformation,  and  to  the 
conclusion  that  any  position  variable  of  observation  would 
suffice  for  observability  of  this  type  target- 
Consideration  of  the  general  target  model  showed  it  to  be 
unobservable  for  any  single  variable  of  observation,  and 
then  a  brief  examination  of  the  moving  surface  target  led  to 
the  important  conclusion  that  ar.  o(  -only  track  is  possible, 
at  least  if  the  target  maneuvers.  Further,  it  appears  that 
the  system  is  far  more  sensitive  to  fluctuations  (i.e. 
noise)  in  the  $  measurements  than  R  or  ok  •  In  Chapter  V 
some  cf  these  perceptions  will  he  tested  by  the  designing  of 
a  deterministic  nonlinear  observer  and  then  tracking  the 
target  with  an  EKF. 
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V.     FILTERING    hM    TRACKING 

The   objective    of    this   chapter    is    to    apply    the    results   of 
Chapter    IV.  Specifically,       this      will    entail      designing    a 

deterministic  nonlinear  observer,  and  then  an  EKF,  in  accor- 
dance with  the  methods  discussed  in  £Ref.  3]  and  [Ref-  8]. 
The  original  coordinates  of  the  problem  as  developed  in 
Chapters  II  and  III  will  be  employed,  rather  than  the 
rectangular  coordinates   of   Chapter    IV. 


A. 


DETERMINISTIC    NONLINEAR    OBSERVER 


Actually,  in  [Ref.  8],  Kirk  only  discusses  the  design  of 
linear  observers,  but  by  employing  the  now-familiar  tech- 
nique of  linearizing  about  an  estimate  with  a  first-order 
Taylor  Series  expansion,  the  technique  can  readily  be 
extended  to  a  nonlinear  system.  Some  alternative  methods  of 
nonlinear  observer  design  are  discussed  in  [Ref-  S], 
[Ref.    10],    [Ref.     11],    and   [Ref.    12]. 

For    the   system   under   consideration, 


x    =    Ax   +    Eu 


y    =    H(x) 


(5.1) 


where 
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Assuming    an   observer-estimated    trajectory    x,    the    observation 
is    linearize!    around    it 
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^   "       -  ^>*      ScU    ^"^)    V    ofL^£YZ-     .      (5.2) 


TEH^aa-S. 


Figure   5.1         Plant   and   Observer   for   the   General   System 

Ignoring  the  higher  order  terms  and  assuming  for  the  moment 
a  constant  velocity  target,  the  linearized  system  can  new  be 
descrired    by 


x    =    Ax 

—        ■*■  —   / 


(5.3) 
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Now,  since  the  method  of  [Ref.  8]  assumes  that  only  the 
measurements  y  are  available,  the  plant  matrix  must  be  simu- 
lated by  the  observer  to  generate  successive  estimates,  i.e. 

x  =  Ax  ,  (5.5) 

—    ,*- 

However,  unless  the  estimates  are  coincidentally  initialized 
to  values  identical  to  the  initial  conditions  of  the  actual 
system,  there  will  be  an  inherent  propogation  error. 
Therefore  a  correction  term  must  be  added  to  equation  5.5  as 
follows: 

x  =  Ax  +  £(H(x)  -  H(X)3  t  (5.6) 

where  G  is  the  observer  gain;  the  determination  of  G  will  be 
discussed  shortly.  Equations  5.1  through  5.6  can  be  illus- 
trated by  the  block  diagram  of  Figure  5.1  . 

To  evaluate  G,   the  first  step  is  to  substitute  equation 
5.1  into  equation  5.6  so  that 


(5.7) 


It    becomes    useful   to    define    the   error    in    x    as 


x    =    x    -   x    '  (5.8) 


x    is    defined   by    subtracting      equation   5.7    from    equation    5.3, 
i.e. 

-   -     "-  -  *-  -  ^  a*  1  £  ^  -  -';* 

Substituting  equation  5.8  where  applicable, 
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or  x  =  Fx  where  F  =  A-  G^L  -  (5.9) 

The  solution  to  equation  5. 9  is 

%(A  --  e  "    xtc)  (5.10) 

which    converges    for    any   F    with    regative    real   eigenvalues. 

For  the  time-invariant  linear  case  where  H  is  a  constant 
matrix,  a  unique  G  matrix  exists  for  any  desired  set  of 
negative  eigenvalues  of  F;  however,  for  the  general  case, 
since  -^  >  obviously  varies  with  state  and  time,  G  must 
generally  be  a  time-varying  or  state-varying  function.  Thus 
the  problem  remains,  how  to  calculate  G.  Many  methods  have 
been  demonstrated  for  the  case  of  the  time-varying  linear 
observer  which  could  be  extended  to  cover  this  linearized 
case;  the  method  of  choice  here,  however,  will  be  the  3KF, 
which  requires  some  preliminary  discussion  prior  to  its 
employment. 

B.        EXTEBDED    KALMAN    FILTER — BACKGROUND 

Both  [  Ref .  3]  and  [Ref.  8]  discuss  the  analysis  origi- 
nally employed  by  Kairaan  and  Bucy  to  develop  the  linear  case 
and  the  so-called  Extended  Kalman  (nonlinear  case)  filter. 
It  suffices  here  to  state  that  the  theory  applies  to 
stochastic  systems,  rather  than  the  perfectly  deterministic 
system  considered  thus  far,  and  involves  perturbation  about 
a  linearized  estimate  of  the  target  track  in  the  same 
fashion    as    Section   A    above. 
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Figure    5.2        Plant    and  Observer  for   the   Stochastic   System 

Figure  5.2  illustrates  the  addition  of  measurement  and 
plant  (or  "system")  noise  to  the  problem.  The  describing 
equations    of    the   plart   are    now 


x    =    Ax    +    Bw 


y    =    H  (x)     +    v 

A-       —'      ' 


(5.  11) 
(5.  12) 
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vhere  w  is  system  noise,  and  v  is  measurement  noise.  It  is 
important  to  note  that  the  form  of  the  observer  has  not 
changed  since  the  discussion  in  Section  A  of  this  chapter; 
now,  however,  the  filter  analysis  provides  a  method  for 
calculating  the  sequence  of  gaii  matrices  G^. 

That  last  statement  concerning  a  sequence  of  G's 
suggests  the  convenience  of  a  discrete  (as  opposed  to 
continuous)  representation  of  the  system.  Considering  that 
the  iterative  calculations  required  to  compute  the  succes- 
sive  estimates  x  will  require  a  measurably  finite  time- 
increment,  it  makes  sense  to  t>ork  with  the  discrete  system 
equivalent  to  the  continuous  system  discussed  thus  far,  i.e. 


x  (k  +  1)  =  ^  x  (k)  +  T  w  (k)  . 


(5.13) 


y  (k)  =  H  (x(k))  +  v  (k) 


(5.14) 
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That  is,  both  the  system  and  observer  noises  are  presumed  to 
be  white   independently  normally  distributed  with   mean  zero 
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and  specified  variances,  which  are  independent  of  the 
Gaussian  random  variable  x(0).  The  observer  equation  5.6 
will  take  the  form 


x(k  +  1)  =  J  £(,V^  r  CCA 


(5.15) 


It  is  now  useful  to  introduce  the  double-subscripted  Dota- 
tion required  to  compute  the  G  (k)  matrices  in  the  EKF  algo- 
rithm,    i.e. 

x(kjk-1)  , 

which  signifies  an  estimate  at  time  increment  k  based  on 
information   available   at    time    increment   k-1,    as    opposed    to 

xfklk^ 

which  represents  the  estimate  at  time  k  given  the  informa- 
tion available  at  time  k. 

The  final  element  required  to  understand  the  EKF  algo- 
rithm is  the  concept  of  the  error  covariance  matrix  E(k), 
which  can  also  be  thought  of  as  the  expected  value  of  the 
error  vector  squared/  i.e. 

P(k)  =  E((x)x). 

Its  derivation  and  significance  is  fully  explained  in 
[Ref.  8],  while  [Ref.  3]  discusses  at  length  its  initializa- 
tion. Suffice  it  here  to  state  that  it  is  an  intrinsic  part 
of    the    EKF    algorithm,    which    can   now    be    summarized. 

Given  the  state  estimate  and  covariance  matrix  at  time 
k-1  and  the  measurement  at  time  k,  the  state  and  covariance 
at    time    k    are   estimated    as    follcws: 


x  (k  |k-1)     =        <fy  v   (fc-t  (vc-t) 


(5.  16) 
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P(kjk-1)    =     $    P(k-«\\c-,^      *        Qp 


(5.17) 


where 


°  <V  c 

o     G   <V] 

The    ZKF    gain  matrix    is   then    calculated   as    follows: 

-\ 

>  (5.18) 


goo  =   P(^HTw[^wtWlL"HT^+5j 


an 

wnere   h  (k)     =  - 


^  Rt^-A 


kNr>       \Z  = 


0        O      'T,    _ 


Finally,      the      state    vector      and   the      covariance   matrix      are 
updated    as    follows: 


x(kjk)    =    \  CA^~\  f    $  £*-) 


yc»4-  vni(>w-» 


p(kik)  = 


T-6WuckU  pWm) 


(5.  19) 
(5.20) 


All  that  remains  is  the  question  of  initialization;  [Eef.  3] 
develops  fully  the  method  used  to  initialize  both  the  state 
vector  and  the  covariance  matrix,  specifically  the  use  of 
the  first  two  target  observatiors  to  generate  initial  esti- 
mates   for   both    x   and    F.  This    method    is    illustrated    in   the 

specific   example    that    follows   immediately. 

C.       TABGET    TRACKING    WITH    THE    EKI 

This  section  discusses  the  development  of  a  computer 
program  designed  to  implement  the  basic  Kalman-Bucy  filter 
algorithm    discussed      in    Section   B    above.  While    admittedly 

crude,      it    serves    as    a      first-cut    tracking    algorithm   and    can 
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be  used  in  conjunction  with  the  observability  analysis  of 
Chapter  IV.  The  problem  divides  itself  naturally  into  two 
parts,  namely  developing  models  for  the  satellite  and  the 
target;  and  then  using  the  EKF  algorithm,  that  is,  equations 
5.16  through  5.20,  to  see  if  the  satellite  can  track  the 
target. 

1 .       Satellite   and  Target    Mo  dels 

This  is  the  time  when  the  various  equations  devel- 
oped in  Chapter  II  (satellite)  and  Chapter  III  (target)  are 
necessary.  For  the  purposes  of  this  problem,  a  satellite 
with  an  altitude  of  600  nm  and  an  orbital  inclination  of 
63.4  is  used,  as  this  is  a  typical  orbital  pattern  used  to 
ensure  whole-earth  coverage  in  a  multi-satellite  constella- 
tion. A  surface  target  simplifies  the  problem  slightly,  as 
x  need  only  be  four-dimensional;  thus  the  target  chosen  is  a 
surface  vessel  on  a  heading  cf  3 1 5  at  a  speed  of  28.3 
knots,  which  equates  to  a  northerly  velocity  of  20  knots  and 
an  easterly  velocity  of  -20  knots.  At  time  zero  (i.e.  k=0) , 
the  satellite  is  located  overhead  the  point  (0  N,0  E) ,  while 
the  target  is  located  at  (45  8,30  E),  which  is  initially 
below  the  satellite's  horizon;  the  program  is  designed  to 
compute  (R,  oL.  i  £  )  as  (0»0#0)  until  the  target  comes  in 
view.  Ihe  computer  program  listing  appears  in  Appendix  B; 
of  perhaps  greater  interest  is  the  data  which  appears  in 
Table  V,  which  shows  the  program  run  for  23  minutes  with  a 
time  step  of  30  seconds,  i.e.  k  running  from  0  to  56.  For 
this  single  pass,  the  target  v«as  in  view  for  117  steps  in 
time,    or    19.5    minutes,    a    fairly   representative    viewing    time. 

2  .   IKF  Operation 

In  the  main,  the  EKF  algorithm  used  in  the  computer 
program  that  appears  as  Appendix  B  is  the  direct  application 
of       the      equations      5.16      through      5.20      to      the      particular 
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TABLE    ¥ 



Target   and   Satellite   Simulation 

with    Observations 

SIEI 

1    TIME      LAT 

LONG 

LAT 

LONG 

RANGE 

ALPHA 

EETA 

0 

0.0 

0.00 

0.00 

45.00 

30.00 

0.0 

0.  00 

0.00 

1 

0.5 

1.50 

0.63 

45.00 

30-00 

0.0 

0.  00 

0.00 

2 

1.0 

3.00 

1.25 

45.  01 

29.99 

0.0 

0.  00 

0.00 

3 

1.  5 

4.49 

1.38 

45.  01 

29.99 

0.0 

0.  00 

0.00 

4 

2.0 

5.99 

2.52 

45.  01 

29.99 

0.  0 

0.  00 

0.00 

5 

2.5 

7.48 

3.15 

45.  01 

29.9  9 

0.  0 

0.  00 

0.00 

6 

3.0 

8.98 

3.80 

45.02 

29.98 

0.0 

0.  00 

0.00 

7 

3.5 

10.47 

4.45 

45.  02 

29.98 

0.0 

0.  00 

0.00 

8 

4.0 

1  1.96 

5.11 

45.02 

29.98 

0.0 

0.  00 

0.00 

9 

4.5 

13.44 

5.73 

45.02 

29.98 

0.0 

0.00 

0.00 

10 

5.0 

14.93 

6.45 

45.03 

29.97 

0.  0 

0.  00 

0.00 

11 

5.5 

16.41 

7.14 

45.  03 

29.97 

0.0 

0.  00 

0.00 

12 

6.0 

17.89 

7.85 

45.03 

29.97 

0.0 

0.  00 

0.00 

13 

6.5 

19.36 

8.56 

45.04 

29.97 

2092.3 

29.85 

58.36 

14 

7.0 

20.83 

9.30 

45.04 

29.96 

1995.2 

30.  33 

58.31 

15 

7.5 

22.30 

10.05 

45.04 

29.96 

1898.  4 

30.  87 

58.  15 

16 

8.0 

23.  76 

10.32 

45.04 

29.96 

1801. 8 

31.  45 

57.  90 

17 

8.5 

25.21 

11.61 

45.05 

29.96 

1705.5 

32.09 

57.53 

18 

9.0 

26.66 

12.43 

45.  05 

29.95 

16  09. 8 

32.  80 

57.01 

19 

9.5 

28.  11 

13.27 

45.05 

29.95 

1514.6 

33.  58 

56.33 

20 

10.0 

29.54 

14.  13 

45.  06 

29.9  5 

1420. 4 

34.  46 

55.46 

21 

10.5 

30.97 

15.03 

45.06 

29.95 

1327.4 

35.43 

54.34 

22 

11.0 

32.39 

15.96 

45.06 

29.94 

1235.  7 

36.52 

52.96 

23 

11.  5 

33.  80 

16.92 

45.06 

29.9  4 

1146.  1 

37.  77 

51.21 

24 

12.0 

35.  20 

17.92 

45-07 

29.94 

1059.3 

39.  22 

49.02 

25 

12.5 

36.59 

16.96 

45.  07 

29.94 

975.3 

40.  93 

46.35 

26 

13.0 

37.97 

20.04 

45.07 

29.93 

895.  7 

43.00 

43.04 

27 

13.5 

39.34 

21.18 

45.  07 

29.93 

822.  1 

45.63 

33.98 

28 

14.0 

40.69 

22.36 

45.08 

29.93 

755.7 

49.  12 

34.04         i 

29 

14.5 

42.02 

23.60 

45.08 

29.9  3 

698.9 

54.  19 

28.  19 

30 

15.0 

43.34 

24.89 

45.08 

29.9  2 

654.0 

62.  50 

21.53 

31 

15.5 

44.  64 

26.26 

45.09 

29.92 

624.0 

79.  04 

14.68 

32 

16.0 

45.92 

27.69 

45.09 

29.9  2 

610.9 

117. 30 

10.03 

33 

16.5 

47.  18 

29.19 

45.  09 

29.92 

616.  0 

166.25 

12.  09 

34 

17.0 

48.42 

30.78 

45.09 

29.9  1 

638.  9 

190. 44 

18.46 

35 

17.5 

49.62 

32.45 

45.  10 

29.91 

677.8 

201.77 

25.35 

36 

18.0 

50.80 

34,22 

45.  10 

29.9  1 

729.7 

203. 48 

31.61 

37 

18.5 

51.95 

36.08 

45.  10 

29.91 

792.  7 

213. 23 

36.96 

38 

19.0 

53.06 

38.05 

45.  11 

29.90 

863.  6 

217. 03 

41.42 

39 

19.5 

54.  13 

40.14 

45.11 

29.90 

941.5 

220.  33 

45.  04 

40 

20.0 

55.  16 

42.34 

45.  11 

29.90 

1024.  0 

223. 37 

48.01 

41 

20.5 

56.  15 

44.66 

45.  11 

29.9  0 

1110.6 

226.  28 

50.39 

42 

21.0 

57.08 

47.  12 

45.  12 

29.89 

1200. 4 

229.  15 

52.30 

43 

21.5 

57.  96 

49.71 

45.  12 

29.89 

1292.  1 

232. 01 

53.85 

44 

22.0 

59.73 

52.43 

45.  12 

29.89 

1385. 7 

234. 92 

55.09 

45 

22.5 

59.53 

5  5.29 

45.  12 

29.89 

1481.  0 

237.  88 

56.05 

46 

23.0 

60.21 

58.28 

45.  13 

29.88 

1577. 3 

240.  92 

56. 8C 

47 

23.  5 

60.82 

61.40 

45.  13 

29.88 

1674.7 

244. 04 

57.37 

43 

24.0 

61.35 

64.64 

45.  13 

29.88 

1772. 5 

247. 24 

57.30 

49 

24.  5 

61.80 

68-00 

45.  14 

29.87 

1870.  9 

250.  52 

58.09 

50 

25.0 

62.  15 

7  1.45 

45.  14 

29.87 

1969. 6 

253.  86 

58.27 

51 

25.5 

62.41 

74.97 

45.  14 

29.87 

2068.7 

257.  25 

58.36 

52 

26.0 

62.58 

78.55 

45.  14 

29.87 

0.  0 

0.  00 

0.00 

53 

26.5 

62.65 

82.16 

45.  15 

29.86 

0.  0 
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problem,  complete  with  the  intermediate  calculations 
required  to  evaluate  some  fairly  involved  matrix  multiplica- 
tions and  inversions.  However,  two  aspects  of  the  program 
require  further  elaboration.  First,  the  filter  initializa- 
tion, to  which  Section  3  of  this  chapter  alluded;  and 
second,  the  computation  of  the  Jacobian  observer  matrix  h, 
which  in  this  case  is  anything  hut  trivial. 

a.   Filter  Initialization 

The  method  developed  in  [ Bef .  3]  has  been 
followed  exactly  here,  thus  a  two-point  initialization  is 
used.  Specifically,  the  northerly  and  easterly  positions 
calculated  from  the  observations  (R,  <x,  A  )  at  time  steps  0 
and  1  (i.e.  the  first  two  nonzero  observations)  are  the 
initial  estimates  for  xv  and  x3  ,  and  from  them  the  initial 
velocities  are  computed,  i.e. 


and       *• 


\0V-    v.,  W-n.Cc 


T 


(5.21) 


From  these   calculations,   it  can   readily  be  shown   that  an 
initial  estimate  of  the  covariance  might  be 
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The  details  of  this  calculation,  which  involve  taking  the 
expected  value  of  the  error  vector  squared  as  discussed  in 
Section  E  above,  appear  in  [ Bef .  3].  While  it  could  be 
argued  that  other  methods  of  iiitial  covariance  estimation 
are  available,  this  method  should  suffice  for  the  purposes 
of   this   analysis. 

This  completes  the  initialization  of  the  filter, 
and  from  time  step  "2"  (third  nonzero  observation)  onward, 
the  filter  runs  according  to  the  algorithm  of  equations  5.16 
through    5.20    . 

b.       Observer    Function    Matrix 


The    observer   function   h    is   defined    for    all    times 


k   as 


UoV 


ax, 

aet- 

Sj5 

o^5 

(5.  23) 


Computation  of  the   matrix  elements  in  the   computer  program 

(Appendix  B)   is  performed  in   accordance  with  the  following 

derivation.    Considei  first  the   following  set  of  equations 

from  Chapters  II  and  III   that  summarizes  the  computation  of 

(K,  °t*A)    from  x  (surface  target  case): 
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Figure    5.3         Functional    Eelationships  Between 
The    State  and  Observation   Vectors 


Obviously,      some    fairly      involved    chain-rule   differentiation 
will    be    required    to    compute    the   partial   derivatives    in    tne    h 
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matrix  of  equation  5.23  .  Figure  5.3  summarizes  the  func- 
tional relationships  tetween  (E  ,  oC ,  A  )  and  x.  By  the  chain 
rule  then 
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(5.27) 


Ail  that  remains  is  tc  perform  the  required  partial  differ- 
entiations on  equations  5.24  for  substitution  as  appropriate 
in  equations  5.25  through  5.27  so  that 
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(5.28) 


It  is  left  to  the  computer  to  calculate  numeri- 
cally the  partial  derivatives  described  by  equations  5.28, 
and  then  substitute  those  values  into  equations  5.25  through 
5.27  to  evaluate  the  h  matrix  terms.  Sequentially,  these 
computations  take  place  after  the  state  and  covariance  esti- 
mates are  calculated,  and  before  the  filter  gains  are 
computed  for  each  iteration  k,  using  x(kjk-1)  in  all  cases. 
This    completes    the    observer    function    derivations. 
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D.   DISCUSSION  OF  EKF  TRACKING  RESULTS 


a. 
2£ 
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Figure  5.4    True  and  Estimated  Target  Track 
FroB  Range,  Alpha,  and  Beta 


Using  the  DISSPLA  graphics  subroutines  at  the  program's 
end,  several  sets  of  curves  vere  generated.  Of  general 
interest  is  the  tracker's  accuracy  when  R,^,  and  ^  are  all 
available,  as  opposed  to  R  and  p(_  only,  or  X  and  &  only 
(passive  tracking,  potentially) .  The  series  of  graphs  that 
comprise  Figures  5.4  through  5-6  show  the  filter's  perform- 
ance for  a  single  pass  of  the  satellite. 

From  these  three  graphs,  it  appears  that  the  filter 
estimate  does  converge  to  the  true  target  trajectory  in  all 
three  cases,  and  that  the  filter  estimate  is  more  accurate 
when  all  three  variables  are  present  than  when  only  two  are 
available.    A  single  run  of  a   random  process  has  a  minimal 
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Figure    5-5         True   and    Estimated    Target    Track 
Froa  Bange    and   Alpha   Only 


amount  of  statistical  signif icance,  however;  thus  repeated 
trials      of    the      filter's      tracking      will   be      required.  In 

[Ref.  3],  Bar-Shalom  discusses  in  several  instances  the  need 
for  multiple  sequential  testing  of  any  filter  based  on 
stochastic  principles;  the  statistical  average  of  these 
"Monte  Carlo  runs"  then  begins  to  have  some  significance, 
increasing  in  value  in  direct  correlation  to  the  number  of 
runs    considered. 

First,      however,         a    criterion      must    be      established    for 
error    comparison.  Bar-Shalom's   suggestion    is      the    use   of   a 

state-squared    error    function,    defined    for    eack    k    as 


SSE[k)     =      <£tv)    P"'(^\^    vJM. 


Application   of  this   criterion  to   this   filter  (not   shown 
here)   indicates  that  while  the  filter   is  able  to  track  the 
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Figure  5.6    Irue  and  Estimated  Target  Track 
Froa  Alpha  and  Beta  Only 


target  in  all  cases,  there  is  room  for  improvement  in  its 
performance.  Specifically,  the  guality  of  the  filter  opera- 
tion can  be  gauyed  by  how  statistically  well  the  SSE  values 
fit  within  a   y^-M  confidence  interval,  where 

N  =  (number  of  runs)  X  (error  vector  dimension). 

In  this  case,  when  a  35%  confidence  interval  (i.e.  the 
region  within  which  95%  of  the  SSE  values  should  fall  based 
on  the  "J^  probability  distribution)  is  considered,  less 
than  half  of  the  SSE  values  fall  within  it  for  any  of  the 
three  cases  under  consideration.  Speculation  as  to  how  the 
filter's  performance  can  be  improved  is  reserved  for  Chapter 
VI;  in  the  meantime,  however,  a  simplified  criterion  can  be 
employed  here  to  attempt  a  rough  evaluation  of  the  relative 
effectiveness  of  the  three  different  modes  of  filter 
operation. 
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Figure  5-7    Simplified  Error  Criterion  vs  Time 
For  a  Single  Trial  of  the  Filter 


A  simplified  error  criterion   that  suggests  itself  might 


te 


SSSE(k)  =  **  *  Yj  +  Tx(*£  ***) 


r\w\ 


where  the  time  step  functions  as  a  scaling  factor  to  roughly 
eguate  the  significance  of  the  position  and  velocity  errors. 
Figure  5.7  shows  the  applicaticn  of  this  criterion  to  the 
single  run. 

Once  again,  the  results  seem  to  validate  the  hypothesis 
that  the  filter  works  better  for  all  three  variables  than 
for  two,  but  this  is  still  information  gained  from  only  a 
single  trial.  Now  that  the  error  criterion  has  been  estab- 
lished, however,  the  Monte  Carlo  runs  can  be  considered. 

The  number  of  runs  is  chosen  to  be  20,  and  the  first 
application  of   the  repeated   trials  was   to  smooth   out  the 
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Figure  5.8    True  and  Estimated  Target  Track 
Froa  Eange,  Alpha,  and  Beta 
For  Twenty  Monte  Carlo  Runs 


estimated  trajectories  in  Figures  5.4  through  5.6;  the 
result  was  the  series  of  Figures  5.8  through  5.10  .  The 
initial  perceptions  of  the  filter's  ability  to  track  the 
target  appear  to  have  been  borne  out,  that  is,  the  estimate 
does  converge  to  the  true  track  in  the  general  case,  and  the 
filter  tracks  better  when  all  three  variables  of  observation 
are  available.  However,  the  initial  error  in  the  estimated 
track  proved  not  to  be  an  anomaly  of  the  particular  trial, 
but  showed  up  repeatedly  throughout  the  Monte  Carlo  runs. 
This  suggests  an  imbedded  error  in  the  initialization 
process  for  the  filter,  possitly  in  the  initial  covariance 
estimate;    this  would   also  help   to   explain  the   filter's 

1. 

failure  to  place  the  SSE  values  in  the  Pso  confidence 
interval.  Examination   of      Figure    5.11,         whi~h    shows      the 
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Figure   5.9        True   and   Estimated   Target   Track 
Fron  Range    and   Alpha   Only 
For    Twenty   Monte  Carlo   Runs 


simplified  error  criterion  for  the  20  runs,  also  tends  to 
validate  the  results  of  the  single  trial,  and  further 
supports  the  supposition  that  the  filter  correctly  tracks 
the  target  in  each  case,  although  there  is  some  initial 
error.  Finally,  Figures  5.12  and  5.13  were  drawn  to  take 
another  closer  look  at  the  quality  of  the  filter  estimates 
ever  20  runs.  It  now  becomes  cbvious  that  a  primary  source 
of  error  is  in  the  initial  velocity  estimates.  Also,  the 
filter's  slow  (30  time  steps  or  7.5  minutes)  convergence  to 
the  true  velocities  indicates  that  sorae  error  in  the  initial 
covariance  estimate  is  indeed  present.  Ironically,  because 
one  initial  velocity  estimate  is  low  and  the  other  is  high, 
the  filter's  initial  estimate  of  the  target's  speed  is 
fairly    accurate;    it    is    the   estinate    of    target  course    that    is 
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Figure  5. 10    True  and  Estimated  Target  Track 
Frcn:  Alpha  and  Beta  Only 
For  Twenty  Monte  Carlo  Runs 


initially  in  significant  error.  This  could  well  be  a  func- 
tion of  the  geometry  of  the  ncrlinearities  of  the  prollem, 
indicating  a  potential  pitfall  cf  assuming  that  white  noise 
will  remain  white  after  undergoing  several  nonlinear  trans- 
formations. Tracking  targets  moving  in  other  directions 
might  well  shed  light  on  the  veracity  of  this  supposition. 

To  summarize  briefly,  although  the  filter's  initializa- 
tion might  be  improved,  it  nonetheless  demonstrates  an 
ability  to  track  the  target  in  all  three  modes  of  operation. 
It  provides  evidence  that  the  target  track  is  more  accurate 
when  all  three  variables  of  observation  are  available  as 
opposed  to  only  two,  but  that  operating  in  the  cC  -  /£  mode 
does  not  really  represent  a  sigrificant  degradation  over  the 
R-o^  mode.  This  is  an  important  result  because  it  allows  for 
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the  possibility  of  passive  target  tracking.  The  supposedly 
unobservable  R- /4  mode  of  operation  is  not  attempted  because 
the  solution  of  the  equations  that  comprise  the  filter  algo- 
rithm without  R  or  p  is  difficult  but  feasible,  but  without 
using  oC  it  becomes  iipossible.  Verification  of  the  unob- 
servability  of  the  target  tracked  by  range  and  altitude 
angle  only  thus  requires  a  different  filter. 

This  completes  the  discussion  of  the  results  of  the  EKF 
tracking  a  surface  target,  a  Ed  concludes  the  analytical 
portion  of  this  thesis. 
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71.    CONCLUSIONS    AND    RECOMMENDATIONS    FOE    FORT HE E    WORK 

During  the  evolution  of  this  thesis,  it  has  become  very 
clear  why  the  observability  of  nonlinear  systems  has  histor- 
ically been  an  unsolved  problem,  at  least  in  the  most 
general  case,  and  inroads  have  teen  made  only  gradually  by  a 
relatively      few      individuals.  The        algebra      involved     in 

applying  any  mathematical  form  of  analysis  to  a  nonlinear 
system  is  frequently  so  prohibitive  as  to  make  such  proce- 
dures of  questionable  value.  Consequently,  the  observ- 
ability analysis  of  a  nonlinear  system  is  frequently  tased 
as  much  on  intuition  as  demonstrable  mathematical  proof. 
Thus  while  the  statement  of  this  problem — observability 
analysis  for  a  satellite  tracking  an  earth-bound  target--is 
reasonably  simple,  it  quickly  becomes  obvious  its  formula- 
tion is  not.  Specifically,  every  reference  available 
pertaining  to  either  the  satellite-target  dynamics  or  nonli- 
near observability  uses  a  different  notation,  and  there  are 
very  clearly  defined  crossover  points  in  the  information 
available.  Most  sources  either  discuss  the  satellite's 
orbit  in  the  language  of  physics,  describe  target  observa- 
tions in  a  purely  empirical  sense,  or  discuss  nonlinear 
observability  as  applied  to  a  general  state  space. 
Consequently,  one  of  the  major  objectives  of  this  thesis 
becomes  the  synthesis  of  as  much  available  information  as 
possible  on  the  entire  problem,  and  the  formulation  of  a 
pertinent  and  coherent  state  vector  model.  For  the  sake  of 
their  universal  recognition,  latitude  and  longitude  are 
retained  as  the  earth's  surface  coordinates,  although  much 
debate  has  taken  place  on  the  subject  of  alternative  coordi- 
nate systems  that  might  pertain.  Certainly,  one  would  hope 
that      there      exists      another      reference      frame       wherein      the 
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mathematical  observability  analysis  of  Chapter  IV  could  be 
simplified  such  that  the  transf crmation  to  rectangular  coor- 
dinates would  not  be  required.  Similarly,  the  calculations 
required  to  implement  the  filter  algorithm  of  Chapter  V 
might  also  be  streamlined.  Because  there  is  potential  for 
continued  exploration  of  these  and  other  aspects  of  this 
problem,  the  suggestions  for  further  work  made  below  are  no 
less  important  than  the  specific  conclusions  that  can  be 
drawn  from  this  research  effort. 

1.   CONCIDSIONS 

As  is  so  frequently  the  case,  the  original  intent  of 
this  research  was  overly  ambitious  in  attempting  to  solve 
both  the  complex  nonlinear  observability  and  target  tracking 
problems.  The  results  presented  here,  however,  do  systemat- 
ically show  the  interrelationship  of  these  problems,  such  as 
through  the  computation  of  the  Jacobian  matrices  for  the 
perturbation  analysis,  for  the  EKF,  and  for  the  observ- 
ability analysis.  This  points  cut  the  need  for  an  efficient 
algorithm  for  high-order  Jacobian  evaluations. 

The  analysis  presented  here  forms  a  good  base  for 
continued  research  on  tracking  satellite  deployment  geometry 
and  desired  receiver  information.  The  parametric  descrip- 
tion cf  the  satellite  dynamics  pertinent  to  this  problem 
involves  a  great  deal  of  information  not  necessarily 
familiar  to  most  engineers.  This  research  proved  inter- 
esting, and  is  well  documented  in  the  literature.  There  is 
a  wealth  of  diverse  information  available  in  sources  such  as 
[Ref.  5]  and  [Eef-  6]-  The  intent  here,  however,  is  to 
integrate  this  information  intc  a  coherent  overview  of  the 
mechanics  of  an  orbiting  satellite  and  its  observation  of  a 
target  moving  on  or  near  the  Earth's  surface,  providing 
enough  information  to  fully  define  the  ^LobleR  without 
drowning  it  in  minutia. 
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Next  the  physical  system  is  redefined  in  terms  of  the 
state  vector  space  more  familiar  to  Electrical  Engineers. 
Also,  the  analysis  establishes  the  computational  procedure 
for  translation  from  observed  satellite  data  to  earth 
surface  coordinates.  Appropriate  coordinate  selection  here 
is  obviously  crucial  to  the  o hservability  analysis.  Any 
method  of  locating  position  cr  describing  motion  on  a 
sphere,  however,  requires  a  radial  vector  and  two  angles, 
which  is  precisely  what  is  defined  by  latitude,  longitude, 
and  altitude  (i.e.  the  radial  vector  from  the  Earth's 
center) .  The  further  conversion  from  latitude  and  longitude 
to  northerly  and  easterly  distance  is  made  in  an  effort  to 
at  least  partially  linearize  the  problem;  the  merit  of  this 
decision  is  proven  by  simulation,  wherein  the  constant 
velocity  target  is  modeled  very  simply  in  these  coordinates. 
Had  latiude  and  longitude  been  retained  in  the  plant  coordi- 
nates, even  this  simple  case  would  have  required  a  highly 
nonlinear  description. 

With  regards  to  target  observability,  the  simpler  cases 
considered  first  are  intended  to  provide  some  intuition 
about  the  problem.  From  the  linearized  case,  it  is  deter- 
mined that  having  the  position  variables  available  for  two 
or  more  observations  is  equivalent  to  observing  both  posi- 
tion and  velocity  during  a  single  look.  Prom  the  case  of 
the  nonlinear  model  of  the  stationary  target,  it  becomes 
obvious  that  the  coordinates  derived  in  the  earlier  chapters 
are  not  especially  well- suited  to  this  method  of  observ- 
ability analysis.  Thus  another  transformation  is  performed, 
this  time  from  the  spherical  space  into  a  rectangular  one. 
Tn  the  process,  it  is  discovered  that  a  stationary  target's 
position  can  be  fixed  with  twc  or  more  looks  at  a  single 
variable  of  observation,  which  might  prove  of  great  utility 
if  it  is  desired  to  locate  passively  a  land- based  radar 
transmitter  or   communications  station.     When  the   moving, 
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airborne,  general-case  target  is  ultimately  considered,  it 
is  shown  that  such  targets  prove  unobservable  when  only  a 
single  parameter  of  observation  is  available.  When  the 
variables  of  observation  are  considered  in  combination, 
however,  the  target  becomes  otservable  in  virtually  every 
case  that  includes  at  least  one  position  variable.  The 
insight  developed  during  the  mathematical  derivation  of  the 
coordinates  suggests  that  the  R- /6  combinations  should  prove 
the  exception  to  this  rule,  and  lead  to  an  unobservable 
system  whether  considering  complete  state  or  just  position 
observability.  Demonstrating  unobservability  conclusively 
by  this  method,  however,  would  reguire  the  evaluation  of 
some  130,000  determinants;  thus  applying  the  analytical 
method  to  demonstrate  this  result  is  of  questionable  practi- 
cality. While  a  complete  nonlinear  observability  analysis 
then  is  almost  impossible,  the  analytical  method  does 
provide  further  insight  into  relevant  aspects  of  observ- 
ability for  the  problem.  One  particularly  important  result 
of  the  analysis  is  the  c^-only  tracking  of  the  maneuvering 
surface  target,  and  the  otr/Z  tracking  of  the  general 
target,  both  very  useful  if  a  passive  sensor  is  of  tactical 
advantage.  As  a  footnote,  the  greater  sensitivity  of  the 
observer  matrices  to  fluctuations  in  /3  than  to  E  or  x  is 
discussed  briefly;  further  dovelopment  of  this  topic  is 
certainly  possible,  although  tiire  did  not  permit  it  here. 

The  first-cut  attempt  at  a  tracking  filter  design  serves 
to  validate  many  of  the  concepts  and  intuitions  brought  to 
light  during  the  observability  analysis,  including  the 
feasibility  of  -X-/5  tracking,  and  the  greater  accuracy 
possible  when  employing  all  the  variables  of  observation. 
The  inherent  problems  of  the  EKI  in  general  and  this  version 
in  particular  lead  cne  to  conclude  that  this  is  not  the 
optimum  method  for  tracking  a  target.  Fortunately,  other 
methods  are  available,   includirg  the  Truncated  Second  Order 
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Filter  (ISO?)  and  the  Gaussian  Second  Order  Filter  (GSOF)  , 
Loth  discussed  in  [Bef.  9]-  Iheir  greater  utility  should 
not,  however,  take  away  from  the  fact  that  this  EKF  does 
generate  an  estimate  that  converges  to  the  target's  actual 
track  in  all  three  phases  of  its  operation,  at  least  for  the 
small  number  of  cases  considered  here.  It  also  proves  that 
the  coordinates  developed  in  Chapters  II  and  III  to  describe 
the  problem,  while  not  particularly  well-suited  to  the 
observability  analysis  of  Chapter  IV,  work  demonstrably  well 
in    engineering    application. 

B.        RECGHME3DATI0HS    FOB    FOBTBEB    SORK 

During  the  development  of  this  thesis,  it  became  obvious 
that  to  discuss  completely  all  aspects  of  this  problem  at 
this  time  would  not  be  possible;  thus  these  recommendations 
for  further  work  are  made.  A  final  word  on  the  subject  of 
coordinate  selection:  for  every  equation  that  appears  in 
Appendix  A  as  part  of  the  Jacotian  observer  matrix  calcula- 
tions, at  least  half  again  as  many  equations  were  derived 
during  abortive  attempts  to  apply  this  method  of  nonlinear 
observability  to  the  problem  in  other  coordinate  systems, 
including  latitude-longitude-altitude,  />-7h  ,  and  R-  'X-$  as 
the  plant  (i.e.  system)  coordinates.  None  of  these  provide 
any  simpler  mathematical  results;  in  fact,  they  all  prove 
even  more  complicated  to  employ.  Perhaps  by  redefining  the 
problem  in  terms  of  a  new  set  cf  coordinates  not  discussed 
in  this  thesis  the  observability  analysis  could  become  more 
streamlined  and/or  definitively  conclusive,  but  no  such 
coordinate    system   has  revealed    itself   thus    far. 

Next  the  question  of  the  tracking  filter  should  be 
addressed.  Had  more  time  been  available,  this  report  would 
have  attempted  to  improve  the  filter  performance,  either  by 
eradicating    the    inherent    errors    apparent    in    the    state   vector 
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and  covariance  matrix  initializations,  or  else  using  a  more 
sophisticated  filter  such  as  the  TSOF  or  GSOF.  Further,  a 
two-stage  nonlinear  filter  has  recently  been  proposed  which 
shows  superior  tracking  perf or  nance  to  any  of  these;  its 
specifications  and  performance  are  discussed  in  [Eef.  10] 
and  [Eef.  12].  The  employment  of  these  or  other  more 
complicated  filters  might  well  afford  the  opportunity  to 
verify  the  feasibility  of  an  <?(.-only  track  of  the  maneu- 
vering surface  target  or  the  purported  unobservability  of 
the  R-£  track.  The  goal  in  this  thesis,  however,  is  not 
actually  to  design  the  optimun  tracking  filter,  but  to 
demonstrate  the  possibility  of  doing  so.  The  EK F  is  a  rela- 
tively simple  algorithm,  and  thus  is  useful  here;  even  so, 
there  is  room  for  further  analysis  of  its  performance. 
Other  methods  of  initialization  might  be  considered,  partic- 
ularly for  the  covariance  martix;  also,  the  tracking  of 
other  targets,  such  as  a  maneuvering  surface  target  or  an 
air  target  with  its  six-dimensicnal  state  vector,  might  be 
attempted.  An  analysis  of  its  sensitivity  could  be 
conducted,  varying  both  the  system  and  the  observer  noises 
in  turn;  this  would  hopefully  validate  the  declaration  in 
Chapter  IV  that  the  system  should  be  more  sensitive  to  fluc- 
tuations in  /5  than  those  in  R  or  j£  .  All  of  these  varia- 
tions on  the  theme  of  filter  operation  could  of  course  diso 
be  undertaken  for  the  alternative  filters. 

No  mention  has  been  made  thus  far  of  multiple  targets  or 
multiple  observers,  but  of  course  the  situation  explored  in 
this  thesis  is  the  simplest  possible,  that  is,  a  single 
target  being  observed  by  a  single  satellite  with  a  perfect 
probability  of  observation  when  in  view.  In  actuality,  of 
course,  the  problem  is  far  more  complicated,  as  the  consid- 
eration of  multiple  targets  and  multiple  observers  immedi- 
ately introduces  the  probability  of  false  target  detection; 
of   improper    correlation   of   targets   to    successive  or 
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simultaneous  observations;  and  of  missing  detection  alto- 
gether. By  viewing  the  entire  process  start-to-finish  as 
stochastic  rather  than  deterministic,  the  problem  ultimately 
achieves      a      true   real-world      significance.  In      [Ref.    3], 

Bar-Shalom  has  pulled  together  a  wide  variety  of  resources 
to  analyze  just  this  sort  of  situation  in  the  general  sense; 
the  application  of  the  principles  discussed  there  for  this 
particular  problem  would  arguably  generate  several  more 
reports  as   involved    as   this   one. 

On  a  higher  level,  the  theoretical  implications  of  the 
applicability  (or  limitations  thereof)  of  the  method  of 
[Ref.  1]  to  this  problem  and  others  of  equal  difficulty 
might  be  discussed.  Previous  employment  of  this  method  has 
shown  the  utility  of  such  observability  testing  in  deter- 
mining the  lack  of  observability  of  the  bearing-only  target 
(EOT)  for  typical  earth-borne  radar  and  sonar  applications. 
The  complicated  geometry  of  this  problem  has  not  yet  yielded 
such  complete  conclusions;  the  potential  exists,  however. 
Another  topic  that  might  be  explored  further  is  the  perva- 
sive nature  of  the  Jacobian  matrix,  which  appears  as  part  of 
the  observability  analysis;  in  the  development  of  the  nonli- 
near observer  here  and  elsewhere,  i.e.  [Ref.  10], 
[Ref.  11  ]#  and  [Ref.  12];  and  again  in  the  computation  of 
the  observer  functions  for  the  filter.  Finally,  tne  contin- 
uing effort  must  be  made  to  resolve  all  these  results, 
current  and  future,  with  the  empirical  evidence  available  of 
track  observability  and  maintainability,  taking  into  account 
both  the  capabilities  of  the  sensor  and  the  wiles  of  the 
target. 
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APPENDS  h 
DERIVATION  OF  OBSERVATION  MATRICES 

The  following  series  of  derivations  follows  the  pattern 
established  in  Chapter  4  Section  B  for  establishing  the 
terms  in  the  Jacobian  observer  iratrices  for  the  general  case 
target.  The  accelerations  are  assumed  to  be  piecewise 
constant  (i.e.  constant  for  each  time  step  of  a  discrete 
observer) ;  thus  third  and  higher  order  derivatives  of  the 
position  variables  will  be  zero.  The  derivations  are 
grouped  by  two's  into  R  and  R,  .^  and  cL  ,  and  /$  and  A  for 
the  reason  that  many  of  the  terms  in  their  matrices  are  the 
same. 

A.   OBSERVER  MATRICES  FOR  RANGE  AND  RANGE  RATE 

Consider  first  that  in  the  rectangular  coordinate 
system, 

Differentiating   this  ecuation  implicitly   six   times   with 
respect  to  time, 

Rft.  *&  -    ^G„,»  va    *  Ccr   «•  <-    *  v\<u*  *  V> 

R^   •    5  ft  ft"*  \G<Ul*     o 
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Taking    the    jiartial    derivative    of   each   of    the   above    equations 
with    respect   to    n, 


c><Z-    ,    OL  rtv>       ,  •  6i  de  o^      .^^6(2.' 


^t  oXV|.    -     "'  o*. 


«■  S^  +  &  «-    *   «-^  ^  <•«  *    '   V5*S*  +  VS  &.*■**   to* 


SvX       -     O. 


Solving    for   the    highest    order   derivative   in    each    equation, 

Sfer-  *    -     rv/fl 


5=    >   (L 


-   A,  (a*  -  S-^k"  ^<L<L) 
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Taking  the  partial  derivatives  cf  the  first  set  of  equations 
with  respect  to  n, 

& &»   ■»  £*£  '  A, 

&&»  *  R„&*  li-i-~  ''2^, 

R  RV  f^-  *«*;*  ****  *  t5i-  r°, 


Solve  for  the  highest  order  partial  derivatives  as  before. 


Obviously,  partial  differentiation  with  respect  to  e  and 
e  and  h  and  h  will  fellow  the  pattern  just  established  for  n 
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and   n;   combining   those   results  will   lead   to  the   first 
observer  matrix  J  for  the  R  observation: 
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Note  that  the  last  equation  of  each  set  of  seven  partial 
derivatives  was  not  required  at  this  time;  they  will  become 
necessary   in    the    case  of    R«  The   lower    rows  of    this    matrix 

are  linear  combinations  of  the  rows  above  them;  to  simplify 
the  matrix  for  the  purpose  of  evaluating  its  determinant  and 
testing  it  for  positive  or  negative  def ini teness ,  it  must  be 
row-reduced  by  subtracting  each  of  the  higher  rows  (multi- 
plied by  the  proper  constant)  from  the  lower  rows  as 
follows: 
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The    resulting   matrix    is 


T  = 


3_ 


L 


All  the  terms  for  the  R  iratrix  J.t  have  already  been 
determined;  they  come  from  the  same  sets  of  equations  just 
derived,      only    the      first   is    left    off   and    the      last   is    aided 
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3y  the   same  method   cf  row   reduction  just   employed,   this 
matrix  will  reduce  to 
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B.   OBSEEVER  HATRICES   FOE  AZIMBTEAL   BEARING  AND   AZIMUTHA1 
BEARING  EATE 

The  derivation  of  the  Jacobian  observer  matrices  for  the 
azimuthal  bearing  variables  q^  and  oC  follows  the  method  of 
the  previous  section,  except  that  the  result  is  not  quite  so 
algebraically  nice.  Consider  first  the  definition  of  in 
this  coordinate  system: 


oL  -  rAM~y  e/ 


Differentiating    once    with    respect    to    time, 

VNe  -  e  rC 


oL-- 


(\S  c 


or 


XjL   -    tvc-ew       ^  =   v\Se\ 


Differentiating    five    more    times   with    respect   to    time, 
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where  "£_  =   f^^ 

\  vV 


Solving    for   the      highest    order    derivative    in      each    equation, 
one    ottains 


/  =    ^    (r\c^  -eu.  -^^) 


IS 


Taking  the   partial  derivative   of  each   of  the   first  seven 
equations  with  respect  to  n, 
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s^i+ii**  ^Li  *  *i  Iw<  3iAZ v  ^ilw-v  wN»y"  --  o, 


where       ^,  ^vC?     ^  ,   ^ 

Ik"-    ^"  ^ec  ,     ^  -   ZrC( 

1--    >tva-^,  lea,  ^c"     Tw^   Da., 

"S.W*   £*.*,  £a/,      I""   --o, 

X"-  o. 

Solving    for   the    highest    order    derivatives, 
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Taking  the  partial  derivative  of  each  of  the  first  seven 
equations  with  respect  to  n  follows  the  same  pattern; 
solving    again    for   the  highest    order    derivative, 


*     ~~° 


4 

where        £  =  AHe\    X    ^O 

^  -    Zaw  *  Zees-.      S_  !    =■    2r\ 

\\\ 

^  --  o. 

The    differentiations    with    respect    to      e    and    e    follow   the 
identical   pattern,         with    the      exception    that      the     (n/n/ai^    ) 
terms   are   replaced    by    (6,6, a.-)     terms    of   opposite    sign,    so 


ok    V 


s, 
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Obviously,      ail      the    partial   derivatives      with    respect      to    h 
will    te    zero. 

This   leads    to    the  formation   of    the    J4     and   JA    matrices 


V 


°^k    c/;     ^e      Ac      O       O 

^k  <^   \  <<e  Q     6 

(?^H  .?Gv      t^G^    j^.4     o      o 


oG*  tX-*  </-e  ^-e     C     G 

>V  W  W  1>* 

oC  qC.^  ^  jG*      O      o 


:  3 


A     ' 


oc^      J-S.     jjCe     jG^    G     G 
^C     oQ    ^  °^<a   G    G 


V\(  \V  w 


p<     oC^  oC^  cL^    c 


c^w  oCi.oL  oL;  c 


o 


G 


which  are  simplified  ty  the  same  sort  of  row-reducing  method 
employed  in  the  J,  and  J  matrices.  This  time,  however,  all 
the    terms   do  not   cancel   simply,    and    the    result    is 
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where 
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C.       OBSERVER       MATRICES      FOR    ALTITUDE       BEARING      AND       ALTITUDE 
BEARING    RATE 

The    derivation    of      the   J      and    J      matrices      for    tha    alti- 


tude  bearing  variables  fe  and  ^  is  the  lengthiest  of  all, 
but  using  the  lessons  learned  in  the  previous  two  sections, 
it      should    prove      no    more      difficult.  In    this      coordinate 

system, 

.    Vv 


/^    Co*"1    W*. 
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Differentiating  once  with  respect  to  time, 

The  next  five  time  derivatives  are  taken  as  before,  and  then 
the  partial  derivatives  with  respect  to  n,  n,  e,  e,  h,  and 
h.  Eliminating  all  the  intermediate  steps  which  would 
follow  in  exactly  the  same  sequence  as  in  the  previous 
section,  the  resultant  observer  matrices  are 
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where 
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APPENDIX    B 


PROGRAM    LISTING    FOR 


THE    SATELLITE-TARGET 
EKF    IMPLEMENTATION 


SIMULATION    AND    THE 


EECLAEE    A 

INTEGER 

REAL 

DT 

REAL 

RO 

REAL 

LA 

REAL 

RA 

REAL 

X1 

REAL 

XH 
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REAL 

XN 
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PN 

REAL 
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DR 
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DA 
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H1 
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XG 
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R  Eiijj 

P3 
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SS 
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LL    VARIABLES 

I, J,K,FLAG1,FL 
,PI, A0,DPHI, OME 
.RHOMAX,RHO, RS , 
TS  (121)  , LONGS  (1 
NGE  (121)  , ALPHA  ( 

(121)  .X2(121) 
AT1  (121)  ,XHAT2  ( 

(12V 
HAT1 
9 

F-«riOHAT-ALhAj. 
HDNU,ENUDX1,  DRA 
LDRH/DALDNU/DAL 
,H2,H3,H4,A, 3,C 
<Q5. 06,35, R6.R7 
1  (12  1)  .YG1  (121) 
VE1  (121) , XAVE2 ( 
NHAT.ICNGT  (121) 

M2lIfPC(12lKI 
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S3AR  (121)  ,E2,E3 
PRECISION    DSZED 


FLAG1 
FLAG2 
DT=.  2 
PI  =  3. 
A0  =  1. 
DPHI  = 
OMEGA 
R0  =  3U 
RS=40 
RHGMA 
ASIG  = 
3SIG  = 
ESIG  = 
NSIG  = 
RSIG  = 
AS  2=  A 
BS2  =  B 
ES2=E 
NS2=N 
RS2=R 


10,2,  COUNT1, 

GA,PHI,DENO 

NU,LATHAT.W 

21)  -TIME  (12 

121)  ,  BETA  (1 

2j121),X4J1 

12:1)  ,XHAT3  ( 

4(121)  ,?9  (T 

AT3,XNHAT4, 

ND,PNE,G8,S 

BHAT/BEriAT/ 

ERH,DRHDX1, 

EX1.DALDX3, 

,DET,R1,R2, 

,R6,R9,RA,R 

,YG2  (121)  -Y 

12  1)  , XAVE3 

,2U3,S5tPI 

NNO'/B.SI-S^ 

LA,D3EDX1  ,D 

,E4, G3, 34, G 


COUNT2 
M,DLAI 
N1-WN2 
1) ,LAT 
21) ,  AS 
21  ,PE 
1  2 1 )  ,  X 
21)  ,PA 
PN1.IN 
7,S8,I 
DLADX1 
DRADX1 
DBEDRA 
R3,R4, 
E  Rr  H 
G3  (1^1 
121)  ,X 
121), P 

,  s  o  ,  g  y 

3EDX3i 
5,  G6 ,  G 


,L,H- 

s,dlc 

,GGNQ 
T  (121 
IG.3S 
(121) 
HAT4  ( 
(121) 
NOVA, 
NNOVR 
,DRHD 
-DNUD 
,DESD 
G  1  g  G2 
5,H6, 
)  ,  SS2 
AVE4  i 
D  (121 
,  GA,G 
XG2  (1 
7,Qt 


N-INK 

NGS 

F,RS2 

),A5  2 

EG, S4 

,PN4 

121) 

,3SIG 

RSIG 

,  NSIG 

LA,GC 

X3,Q2 

RE, 03 

,  iiS2 

D.E.I 

kW 

21) 


=0 

=0 

c 

1415926 

1065387 

EI/53.7243 

=PI/720. 

33. 

38. 

X=ACOS(R0/RS) 

EE/103000. 

EI/108000. 

.002 

.002 

.1 

SIG**2 

SIG**2 

SEG**2 

£IG**2 

SIG**2 


OUTER    OUTER    LCOP    FOR 
DO    36    INK=1  .3 

D5EED=123486579. 


ALTERNATIVE    OBSERVATIONS 


92 


COTER  LOOP  FOR  MONTE  CAREO  RUNS 
DO  92  1=1, 

XAVE1  [T 

XAVE2  il 

XAVE3  il 

XAVS4  (I 

SSE3AR  ( 
CONTINUE 


121 


DO    94    N=1,20 


INITIALIZE    TIME, 


POSITIONS,     MEASUREMENTS 
TIME  " 
LATS 

long: 

LATT  (1)  =45.*PI/180. 
LONGT    1)  =30. *P  1/180. 
RANGE    1)  =0. 
ALPHA  (11=0 


,Ufli>,     at, 
I(1)=0. 

;ji  =o. 


BETA 
X1  (1 
X2  (1 
X3  (1 
X4  (1 


(1)  =0. 

)  =R0*LATT  (1) 
=. 333333 j 

=R0*COSifLATT{1)  )  *LONGT(1) 
=-.3333333 


LOOP    TO    UPDATE    TIME.     POSITIONS.     MEASUREMENTS 

DO    10   1=2,  121 
K=I-1 
TIME  (I)  =DT*FLOAT  (K) 

SATELLITE    POSITION 
PHI  =  DPHI*TIME(I) 

LENOM=COS  (PHI)  **2  +  (CCS  (A0)  *SIN  (PHI)  )  **2 
DLONGS=DPHI*COS (A0) /EENOM-OMEGA 
DLATS=DPHI*SIN  (AO)  *CCS  (PHI)  /DENOH**-  5 
LATS  (I)  =LATS  (K)  +DT*DLATS 
LONGS  (I)  =LCNGS  (K)  +DT*DLONGS 

TARGET  POSITION 

I-TN1=NSIG*GGNQF  (DSEED) 

WN2=ESIG*GGNQF(DSESDj 

X1  (I)=X1  (K)+DT*X2  (K)  +DT**2*WNl/2. 

X2/I) =X2    K) +DT*HNT 

X3  'I)=X3    K)+DT*X4(X)  +DT** 2*WN2/2. 

X4  /I)=X4   'K)+DT*WN2 

LATT  (I)  =  X1  (I) /RO 

LONGT  (I)=X3  (I)/(R0*CCS  (LATT  (I)  )  ) 


MEASUREMENTS 

NU  =  LONGT (I) -LONGS  (I' 

RHO=ACOS  'SIN  (LATT  (l)  )*SIN  (LATS  (I))  +COS  (LATT  (I)  ) 
+  *COSJLATS  (I)  \  *COS(NU)  ) 

[RHO.LE.RHOMAX)     GC    TO    30 

'     (  (FLAG1.NE.  1)  .OE.  (FLAG2.  NE.O))     GO    TO    60 
COdNT2=K 
FLAG2=1 


IF 


k 


60  RANGE  (11=0. 

ALPHA (I) =0. 
BETA  (II =0. 
GO    TO    10 

30  IF     (FLAG1.EQ.0)     COUNT1=I 

FLAG1=1 
RANGE  (I)=  (R0**2+RS**2-2.*R0*RS*COS  (RHO)  )  **.5 
+  +RSIG*GGNQF  (ESEED) 

ALPHA  (I)  =ASIN  (COSILATT  (I)  )  *SIN  (NUJ/SIN  (RHO)  ) 
+  +  ASIG*GGNQF  (ESEED) 

IF     (LATT  (I)  -LT.LATS(I)  )     ALPH  A  (I)  =PI -ALPHA  (I) 
BETA  (I)  =ASIN  (R0*SIN  (RHO)  /RANGE  (I)  ) 
+  +ESIG*GGNQF  (DSEED) 

10  CONTINUE 

M=COUNT2-COUNT1  +  1 


C 

c 


ESTIMATION 

TARGET  NOT  YET  IN  SIGHT 
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J=C0UJiT1-1 
DO    40 


40 


CONTINUE 


XHA11 
XHAT2 
XHAT3 
XHA14 


1  =  1  ,  J 


TWO-POINT    INITIALIZATION    OF    THE    EKF 
J= COUNT  1  +  1 
DO    80    I=C0UNT1,J 

RH0=ASIN(RAN3E(I)  *S  IN  (BET  A  (I)  )/R0) 
LATHAT=ASIN  (SIN  (LATS  (I)  )  *COS  (RHO)  +COS  (LATS  (I)  ) 


NU=ACOS  (  (COS  (RHO)  -SIN(LATHAT)  *SIN  (LATS  (I)  )  )  / 
(COS (LATHAT)  *COS  (IATS (I) )  )  ) 
IF     (ALPHA(I).GE.PI)     NU  =  -NU 
LONHAT=LONGS  (I) +NU 
XHAT1  (I)=E0*LATHAT 
XHAT2  (I)  =0- 

XHAT3  (I)  =  R0*COS  (LATHAT)  *LONHAT 
XHAT4  (I)  =0. 


80 


CONTINUE 

XHAT2  (J)  =  (XHAT1 
XHAT4  (J)  =  (XHA 


T1 (J)- 


-XHAT1  (COUNT1)  ) /DT 

~UNT1) ) /DT 


UPDATE    THE    EKF 


XEAT3  (CO! 

P1'(J)  =NS2 

PD  (J'i  =NS2/DT 

P4  (J)  =2.*NS2/DT**2 

P3  (J'i  =ES2 

?F  (J)  =ES2/DT 

P9  (J)  =2.*ES2/DT**2 

PA  (J'i  =0. 

PB  (J'i  =0. 

PC  (J)  =0. 

PE  (J)  =0. 


J  =  J+1 

DO    50    I=J,COUNT2 
K=I-1 


PN1=P1 
PND=PD 
PN4  =  P4 
PN3=P3 
PNF=PF 
FN9=P9 
?N3=PB 
PNA=PA 


+2.  *DT*?D(K)+DI**2*P4"  ( 
+DT*P4 (K) +N52*DT**3/2. 


+DT*XHAT2  (K) 
+DT*XHAT4 (K) 
:)  +  NS2*DT**4/4. 


STATE    AND    COVARIANCE    ESTIMATES 

XNHAT1=XHAT1 
XNHAT2=XHAT2 
XNHAT3=XHAT3 
XNHAT4=XHAI4 

K) 

'K;  +  NS2*D?*'*2 
K)  +2.*DT*PF(K)  +  DT**2*P9  (  K)  +ES2*DT**4/4. 

i'K*   +DT*P9(K)  +E£2*DT**3/2. 

iKi +ES2*DT**2 

IK'   +  DT*  (PE  (K)  +PA  (K)  )  +DT**2*PC  (K) 
J^NA=PA  (K)  +  DT*?C(K) 
?NE=PS(K)  +DT*PC(K) 
PNC=PC(X' 


OBSERVER    FUNCTIONS 

LATHAT=XNHAT1/R0 

LONHAT=XNHAT3/ (R0  *COS  (LATHAT) ) 

NUHAT=LONHAT-LONGS (I) 

RHOHAT=ACOS  (SIN(LATHAT)  *SIN  (LATS  (I)  )  +COS  (LATHAT) 

*COS(LATS  (I)  )  *CGS(NUHAT)  ) 
RHAT=  (R0**2+RS**2-2.  *R0*I<S*COS  (RHOHAT)  )  **.  5 

ITUHT-UCH    //"rvC    /  T     J\  c  t-   - 


ALHAT=ASIN  (COS  (LATHAT)  *S  IN  (NU  HA'T) /SIN'(R  HOHAT)  ) 

IF     (LATHAT.  LT.  LATS  (I)  )      ALH  AT=  PI-ALH  AT 
BEHAT  =  ASIN  (R0*SIN (RHCHAT) /RHAT) 
DLADX1=1./R0 


123 


+ 
+ 


+ 
+ 


EKF 


DRHDLA=  (S 

DRHDNU=C0 
SI 
DNUDX1=XN 
DRHDX1=DR 
DRADRH=RO 
DNDDX5=1 . 
DEADX1=DE 
DRADX3=DR 
BALDLA=-S 
*S 
DALDHH=-C 


DALDN 


u^c 


*s 

DALDX1=DA 

DALDX3=  (D 

D3EDRA=-R 

DBEDRH=RO 

DBEDX1=DB 

DBEDX3=DB 

H1=DRADX1 

H2=DALDX1 

H3=DBEDX1 

H4=DRADX3 

K5=DALDX3 

H6=DBEDX3 

IE     (INK 

IE     (INK 

IF     (INK 

IF     {INK 


IM(LATHAT) * 
S  (LATHAT)  *S 
5  (LATHAT)  *C 
N  RHOHAT) 
HAT3*SIN  (LA 
HELA*DLADX  1 
*RS*SIN(RHO 
/(E0*COS  (LA 
AERH*DRHDX  1 
ADRH*DRHDNU 
IN  (LATHAT)  * 
IN /RHOHAT)  ) 
OS i LATHAT)  * 

os  (alhat) *s 
5(lathatj  *c 
in  (rhohat)  ) 
ld£a*dladxi 
aideh*drhdn 
0*sin (rhoha 
*cos  (rhohat 
zera*dradx1 
zdea*dradx3 


COS  (LATS  (I 
IN(LATS  ' 
CS  (LATS 


\B 


*COS (NUHAT)- 
/SIN( RHOHAT) 
*SIN  (NUHAT)/ 


THAT)  /  (R0*COS  (LATHAT)  )  **2 
4DRHDNU*DNUDX1 
HAT)  /RHAT 
1HAT)  ) 

*DNUDX3 

SIN (NUHAT) /  (COS (ALHAT) 

SIN  (NUHAT)  *COS  (RHOHAT)/ 

IN  (RHOHAT)  **2) 

CS  (NDHAT)  /  (COS  (ALHAT) 

+DALDRH*DRHDX1+DALDNU*DNUDX1 

U+DALDNU) *DNUDX3 

T)  /(RHAT**2*COS  (BEHAT)  ) 

)/(RHAT*COS  (BEHAT)  ) 

♦DBEDRH*DRHDX1 

+DESDRH*DRHDNU*DNUDX3 


H3=0 
H6=0 
H1  =  0 
H4=0 


D=PN1*H1*H3+PNB* 
E=PN1*H2*H3+?NB* 
F=3S2+PN1*H3**2+ 
DET=A*C*F+2. *B*E 


2.*P 
(H1* 
2.*P 
(HI* 
]H2* 
2.*P 
*D-C 

02  = 
Q3  = 

04  = 

05  = 

06  = 
P1  = 
R2  = 
R3  = 
R4  = 
R5  = 
R6  = 
R7  = 
S8= 
R9  = 
RA  = 
RB  = 
FC  = 
G1  = 
G2  = 
G3  = 
G4  = 
G5  = 
G6  = 
G7  = 
G8  = 
G9  = 
GA= 


NB 
H5 
NB 
E6 
H6 
NB 
*D 
C 
D 
A 
B 
B 
A 
1 
H2 
H3 
F.1 
H2 
K3 
H1 
E2 
H3 
F.1 
H2 
F.3 
El 
51 
R1 
E4 
E4 
E4 
R7 
B7 
F7 
FA 


*2 


*H1*H4+ 

+H2*H4) 

*H2*H5+ 

♦H3+H4) 

+  H3*H5) 

*H3*H6+ 

**2-F*B 

*E-B*F 

*E-C*D 

*D-A* 

*C-B** 

*PN1+H4 

*PN1+H5 

♦PN1+H6 

*PND+H4 

*PND+H5 

*PND+H6 

*PNE+H4 

*PNB+H5 

*PNB+H6 

*PNA+H4 

*PNA+H5 

♦PNA+H6 

*Q1+R2* 

*Q2+R2* 

*Q4+R2* 

♦  QH-R5* 

*Q2+R5* 

*Q4+R5* 

*Q1+R3* 

*^2+R3* 

*Q4+R8* 

*Q 1+RB* 


PN3*H4**2 

+PN3*H4*H5 

PN3*H5**2 

+PN3*H4*H6 

+PN3*H5*H6 

PN3*H6**2 

**2-A*E**2 

)/DET 

/DET 

)/DET 

/DET 

/DET 

)  /DET 

*PNB 

*PNB 

*PN3 

*PNE 

*PNE 

*PNE 

*PN3 

*PN3 

*PN3 

*?NF 

*?NF 

*PNF 

Q2+R3*Q4 

Q3+R3*05 

Q5+R3*Q6 

Q2+R6*Q4 

Q3+R6*Q5 

Q5+E6*Q6 

Q2+R9*Q4 

C_3+R9*Q5 

Q5  +  R9*0_6 

Q_2+RC*Q4 
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GB=BA*Q2+RB*C3+RC*Q5 
GC=BA*Q4+R3*Q5+RC*Q6 


STATE  AND  COVARIANCE  ! 
INNOVA=AL?HA(I)  -A: 
INNOVB=BETAJ±) -BEJ 
INNOVR=EANGE  (I)-RI 
XHAT1  (I)=XNHAT1+G 
XHAT2  I) =XNHAT2+G< 
XHAT3 (I)  =XNHAT3+G' 
XHAT4  (I)  =XNHAT4+Gj 


"fi+G2*IN 
rR+G5*IS 

rR+G8*IN 
'R+G3*IN 
!1*H1-G2 
:H4-G2*H 
:H1-G5*H 
:H4-G5*H 
:H1-G8*H 
I7*H4-G3 
:H1-GB*H 
:H4-GB*H 

;i*pni+s 

;i*pnd+s 
;3*pnd+s 
;5*pnb+s 
;5*pna+s 

!7*PNA  +  S 

;i*pna+s 

;  1*PNB+S 
!3*PNA  +  S 

o*PND  +  S 


NOVA* 
NOVA  + 
NOVA  + 
NOVA  + 
*H2-G 
5-G3* 
2-G6* 
5-G6* 
2-G9* 
*H5-G 
2-GC* 
5-GC* 
2*PNB 
2*PNE 
4*PNE 
6*PN3 
6*PNF 
8*PNF 
2*PNF 
2*PN3 
4*PNF 
6*PNE 


G3* IN NO VB 

G6*INHOVE 

G9*INNOVE 

GC*INNOV£ 

3*H3 

H6 

H3 

H6 

H3 

9*H6 

H3 

H6 


+  PN4 
+  PN9 


+  PNC 


AVERAGED  PERFORMANCE  AND  SQUARED  ERROR  FUNCTIONS 


XAVE1  (I)=XAVE1 
XA7E2  (Ij  =XAVE2 


I)  +XHAT1 


+XHAT2 
+XEJET3 
+XHAT4 


50 


XAVE3  ,'I)=XAVE3 
XAVE4   'I)  =XAVE4 
E1  =  X1  il) -XBAT1  . 
E2=X2  /I)  -XHAT2  i'I 
E3=X3  (I'  -XHAT3  i'I 
E4  =  X4  (I)-XHAT4  (I] 
SSE    I) = (E2**2+E4**2) *DT**2+E1 **2+S3**2 
SSEBAR(I)  =SSEBAR  (I)  +  SSE  (I)/20. 
CONTINUE 


TARGET    OUT    OF    SIGHT 


70 

94 


CONTINUE 
CONTINUE 

GRAPHICS 


J=COUNT2+1 
DO    70    I=J,  121 
K=I-1 

XHAT1 (I) =XHAT1 
XHAT2    Ii =XHAT2 
XHAI3  (I) =XHAT3  , 
XHAT4  (I)  =XHAT4  (K' 


+DT*XHAT2(K) 
+DT*XHAT4  (K) 


84 


82 


J=CCUNI1+2 
K=M-2 

DO    90     I=J,COJNT2 
L=I-J+1 

IF     (1NK.NE.  1)     GO    TO    84 
XG  1(L)  =XAVE3  (I) 
YG  1(L)  =  XAVE4(I) 
GO    TO    90 

if    (ink-ne-2)    go  to  82 
xg2(d  =xave: 

YG 

GO 
XG3  (I)  =XAVE3  (I) 
YG3  (I)  =XAVE4(I 


G21L)  =XAVE3  (I) 
G2JL  =XAVE4(I) 
O    TO    90 
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90 
86 


CONTINUE 
CONTINUE 


CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

Xfl  =  XL 

YW=YL 

XL=8. 

YL=6. 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 

CALL 


lEf 
IE] 


LRGBUF 

TEK618 

PAGE  {1 

NOBRDR 

AREA2D 

XNAHE 

YNAM 

GEAF 

LINES  { 

LINES  f 

LINES  [ 

EGND  (I 

EGND/I 

5-2.5- 

-. 5-YW 

THKCRV 

CUEVE  ( 

DASH 

CURVE ( 

RESET 

DOT 

CURVE ( 

RESET 

RLVEC 

LEGEND 

ENDPL ( 

DONEPL 


1.,8.5) 


(8.5,6 


*f  ERL  Y 


'  EAS 

•EASTERLY 
262.,  1.  ,  1272. 
'RANGE,     ALPHA 
'RANGE    AND 


MILESS'  ,  100) 
VELOCITY     (KNOTS) 


'ALPHA    AND 

PAK,3) 

PAK,3! 


-21.  J.,-13.    ) 
AND    BETAS', IPAK, 
ALPHA    ONLY$',IPAK,2) 
EETA    ONLY3' ,IPAK, 3) 


100) 
1) 


XW-.  1 

-.1 

(.02) 
XG1,YG1 


K,4) 


XG2,YG2,K,4) 

'EASH') 

XG3,YG3,K, 4) 

'  DO  T ' ) 

1262.  ,-20.  ,  1272.  ,-20 

(IPAK,3,XL,  YL) 

STOP 

END 


0000) 
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